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l. INTRODUCTION 


Since they are operated in three dimensions and because of their diflerent body 
structure and operational conditions. submarines alwavs present a great challange for 
automatic control engineers. Especially for submarines with extremely high underwater 
speeds, it 1s Very important to have automatic controls which can be used effectively. 

In this study, using the equations of motions in six degrees of freedom which were 
developed by Naval Ship Research and Development Center (NSRDC), a linearized 
submarine model was derived for both horizontal and vertical motions. It was obvious 
that working with a linear model is much simpler then with a complete nonlinear model. 
Also the automatic control svstem design procedures which are used in this study require 
a linear model for decoupling. Even though the linearized model does not introduce a 
cross-coupling effect between horizontal and vertical motion, as would a real submarine, 
it works in almost the same wav the nonlinear model does. 

[n designing an automatic controller for both vertical and horizontal motions, a 
MIMO ( Multi-input Multi-output ) system representing the submarine, has to be in- 
vestigated. Inputs are propeller which creates the forward speed, rudder for horizontal 
motion, and the bow and stern planes for vertical motion. The outputs are the three 
speed components u, Ww, Vv and roll, yaw, pitch angles around three axes of the submarine. 
Also a ballast svstem can be used to maneuver the submarine but it 15 not included in 
this studv assuming the submarine 1s alwavs 1n trim. 

The pitch and vaw angles and the depth have the main importance for maneuvering 
a submerged submarine. Therefore the automatic control system 1s designed to control 
Bi oe three states. 

After obtaining valid linear models for both horizontal and vertical motions, the 
method of the automatic control design has to be chosen. One of the most popular de- 
sign method 1s optimal control theorv but it requires feedback of both position and rate 
information. This information ts available for submarines which are equipped with an 
inertial guidance system. For the small coastal submarines which do not have an inertial 
guidance system, a different design approach must be carried out. A possible way would 
be the design of cascaded compensators using only position ( such as depth ) feedback. 

There is always a cross-coupling effect between vertical and horizontal motion in a 


submerged submarine which is also called a squatting effect. The cross-coupling effect 


is simply ‘the rudder effect on vertical plane which makes the submarine pitch up and 
change depth when a rudder angle is applied. The cross-coupling eflect is also investi- 


gated in this study. 


το 





H. EQUATIONS OF MOTIONS IN SIX DEGREES OF FREEDOM 


A. BACKGROUND 

With diving capability, submarines differ from surface ships. Thev also have com- 
pletely different hull structures, hydrodynamic specifications and relatively complex 
control and stability problems. A submarine can be operated in all six degrees of free- 
dom. To maneuver usually three sets of plane surfaces, the propulsion system consisting 
of one or two propellers, and a ballast svstem consisting of two or threc ballast tanks for 
different tvpe of submarines are used. 

To control horizontal motion the submarine has a usual rudder such as surface ships 
do. But in vertical motion, a submerged submarine needs at least one more control sur- 
face to maintain the desired depth and pitch angle.A classic submarine has bow planes, 
which can be used to keep ordered depth, and stern planes, which can be used to tilt the 
submarine to an ordered pitch angle. Depending on the submarines’s speed and condi- 
tion these planes can have an appreciable interaction. 

Modern submarines usually have bow planes on their sails, which are called 
fairwater planes. Ilowever, high underwater spceds reduce the necessity of bowplanes. 
lt is possible to keep ordered depth without using bow planes while operating with 
higher underwater speeds. Since the numbers presented bv NSRDC [Ref. I: p. $8] are for 
an American submarine, bow and fairwater planes were both considered m this study. 

^n illustrative picture of a submarine with axes, velocity and plane definitions 1s 
given in L1g.1. The arrows are pointed in the positive motion direction. ] his coordinate 
system Is the right hand orthogonal svstem which is fixed in the submarine and moves 
with it. The origin of the coordinates 1s located at the center of gravity with x-axis along 
the center plane. The positive x direction 1s forward, the positive v direction 1s horizon- 
tally to the right, and the positive z direction is down. [Ref. 2: p. 438] 

The heading of the submarine is the direction of its X-axis, and this is measured as 
an angle with respect to the geographic coordinate system. The heading angle, also 
called the vaw angle, 1s defined to be the angle between the direction of the ships x-axis 
and the direction of the x-axis of the geographic coordinate system. Phe symbol used for 


the yaw angle is y. 
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Figure L. A Submarine with Axes of Motion 





The pitch angle of the ship ts the rotation around its y-axis. It ts defined to be the 
angle between the direction of the ships x-axis and the horizontal reference line. The 
svmbol used for the yaw angle is @. 

The roll angle of the submarine 1s the rotation around its x-axis. lt is measured from 
Memveriical reference to the direction of the submarme z-axis. The svimbol used for the 
roll angle is ó. 

Kl (llocs for the x. yand Z directions are u, v and w respectively, which can be 


called velocity components of linear velocity of body axes relative to an earth-fixed axis 


system. 


Definitions for all symbols used in this study are given in Appendix A. 


B. DERIVATION OF THE LINEARIZED MODEL 

The equations of motion are derived by summing the applicable forces and moments 
in each degree of freedony surge(x), swav(v), heave(z), roll(ó), pitch(0) and. vaw(y). 
Reference ] presents the standard sets of equations of motion developed for submarine 
motion studies bv NSRDC. These equations are general enough to simulate the trajec- 
tories and responses of submarines in the six degrees of freedom resulting from various 
tvpes of maneuvers. Thev simulate motion of a given ship design upon msertion of the 
nondimensionalized hvdrodvnamic coefficients developed for that particular design. In 
addition values must be supplied for propulsion force and rudder and diving plane an- 
gles. A complete set of hvdrodvnanuc coeflicients and other required data used in this 
thesis is given on Appendix B. 

The derivation of equations of motions In six degrees of freedom which are to be 
Eneanzed. was discussed in several earlier studies. [Ref. 3 , Ref. 4 .] The authors were 
satisfied that these equations are valid and can simulate a submarine's motion eflec- 
ively. 

l. Assumptions 

l'orward speed can be taken as constant. Linearizing about the axial speed,u, 
which aflects nearly every term in the standard equations, could be verv complex, so the 
forward speed was assumed to be constant. This also reduces the degrees of freedom to 
i e. 

Roll angle is assumed to be small. Under normal circumtances in submarine 
maneuvering, the roll angle usually stays within +5°. Large roll angles are only caused 


by high speed plus hard over rudder. Therefore, the roll angle can be neglected. 


Cross-products of inertia can be neglected. This assumption is common to all 
submarine simulations because the hull and interior layout of submarines is approxi- 
matelv svimnietric 

All terms including 17, can be discarded. Since it is assumed that the submarine 
is in trin. weight of water blown Irom a particular oallast tank, H^, must equal zero. 

All terms involving nonlinearity are neglected. 

Vertical motion is decoupled from horizontal motion. Asa result of the first five 
assumptions it also has to be assumed that there is no coupling between vertical and 
horizontal motion. 

2. Derivation of the linear equations of Motion 
a. Linearization on the vertical plane 
The lmearized form of the equations on vertical plane are: 


1) Equation of Motion Along z-axis (Normal! Force): 


nuk — umg = x E = Ue, Mu on n a (Z,uw + u “ο. + Z ob) (1) 


where 
slug 
κο m mass density of sea water, 
l2 4135 ft. , submarine length, and 
nt 6.25x10* slugs , submarine weight. 
AM values for the hvdrodynanuc coeflicients are given in Appendix B. 


substituting these numbers into the equation, and after performing the required algebra 
NER EE vn P M. | qnc, 2s qnd. 2s 
w-—S5.11q —1.632x10 ^iov 0.261pq —7.416x10. 40s —3.71xlO. δ (2) 


2) Equation of Motion About v-axis: 
Lý = — : - PM) 4 = Maug + My) +5 Maw A n μι 


After substituting appropriate numbers and required algebra 


g= —4.975x10- ^W —6.219x107 ΠΤ 798x107 uy —1.5x107 ὃς 4- 3.0x10 $u^6b 
-2.516x1070 


If these two equations are substituted into each other 





i = 0.294ug —1.7228x10 uw —6.667x10 u Ss —3.873x10 u 0b —0.01280 (5) 


Q = 1.884x10 uw —6.365x10 ug —1.465x10 Pu Ss +3.193x107f 5b +2.522x1070 (6) 


These two equations describe the state variable representation of tlie 
linearized, vertical plane equations of motion. However they do not have the depth as 
a state Variable. In order to make the depth a state variable, these equations are to be 
modified by using linearized auxilary equations Which are given in Appendix C. There- 
fore the auxilary equation used for the modification 15 

Z,- —uSinÜ 4- vCos0 sin ó + v cos 0 cos ó 
Using our assumptions the linearized equation will be 
ry = —u8-w 


Then the modified linear equations of motion have the following form 


Z = -1.728x10 uz —0.706ug + (0.01283 —1.728x10 73 ^)8 —6.667x107 u ðs 


Te οτι οὐ 


(7) 


j 2 L884x10 7 uz —6.365x10 7 ug —1.465x10 u ós +3.193x107 u ób 


Š 
s: I TO uo ευ δ 


As it Was mentioned before the forward speed u is not a state variable but 
a constant Which can be changed as desired. A complete block diagram for vertical mo- 
tion 1s given in ligure 2. 
b. Linearization on the Horizontal Plane 
The linearized form of the equations on horizontal plane are: 
1) Equation of motion along y-axis (Lateral Force): 


p l ET DS P 3 S Š E 
π᾿, ο SP) 


) 
a E PY uv 4 i Ys ór) 


HlY — mur — 


(9) 


Using same set of numbers and hydrodynamic coefficients, the final form 


of the equation is 


r2 1.89; — 6.3p — 0.291ur — 0.035up — 2.563x10 7^ uv - 7.568x10 2 ór (10) 


zu 2 τυ 
3.87x10 u 173x10 u 

m WEE 
66/xl0 u 

-5 
1.88x10u 

-3 > 

0.013-1.73x10 u 







ds 






ligure 2. . Glock Diagram for the Linearized Model on the Vertical Plane 





Ip = L (Rp A ets l'(K,up RSEN HIA i joe L£ (Kuy + ° Kar) + Bzgó (11) 


The final form of the equation 1s 


p= —0.679% — 0.05846 — 8179x107 up — 9.347x10 "ur —3.942x107 7 hi 
+ 3.942x10 ^u ór — 0.2360 | 


3) Equation of motion about z-axis ( Yawing Moment) 
) 
Li- = POV + Np) + = (Nur 9 Nyup 4 Na) + E P(Njuv + uN dr) (13) 


The final form of the equation 15 


jm —6.553x10 7p -- 6767x107 ^$ — 6.767x10 ^ ur —4.511x10 up — 4.076x10 uv 
—1.631x107 uw dr 


These three equations are supposed to describe a submerged submarine 
motion in the horizontal plane. The onlv difference from the equations for vertical mo- 
tion is the equations for the horizontal motion have the order of the highest derivative 
of all the variables such as v, p and r in each particular equation. [Ref. 4: p. 48] 

Having all of the highest derivatives in each particular equation creates 
an algebraic loop problem for the simulation. To solve this problem it is possible to 
manipulate the equations to eliminate the highest order derivative from one of the 
equations Which includes the other derivative as it was done before for the vertical plane 
equations of motion. This was done very nicely for the case of two equations but does 
not seem to be very attractive When there are three or more equations mvolved. 

There are some other possible ways to solve algebraic loop problems. But 
since the new version of DSL [Ref. 5] can take care of this problem automatically, it is 
preferred to use those equations in simulation. 


^ complete block diagram for horizontal motion 1s given in Figure 3. 


dr 


568% 104u2 


2.56% 103u 
qmm a 


| 
E 


0.035u 


y 
p 
3.942x 105u2 8.18x103u 

* | 0.0584 !' 
Y 13942104 - | | 
7 X 2 μα. 
EER 


^U s E 





中 






Oe 


6.767% 103u 


| 1 中 
b - 


| y - 
4.067x105u 


Figure 3.) Block Diagram for the Linearized Model on the Horizontal Plane 





C. VALIDATION OF LINEAR MODEL 

The objective of this section is to compare the dynamics of the standard model with 
the derived linear model in botli vertical and horizontal planes. 

In order to compare both models thev should be in the same initial state and both 
models have to be in trim. In trim has the meannig that the submarine maintains depth 
at a given speed with the desired pitch angle without using bow or stern planes. When 
making linearizing assumpuons the terms which are related to trim are already ignored. 
Therefore the linearized model will be in trim at all times. Because of the submarine hull 
and sail structure it 1s required to adjust ballast tanks for given speed. Thre corrections 
for trim which are used in the simulation for this study are obtained from an earlier 
thesis study. [Ref. 6: p. 184) 

To validate the lmear model it 1s preferred to obtain both the initial condition and 
forced response in order to make sure that the linear model is working properly. 

I. Validation of Linear Model on Vertical Plane 

a. Initial Condition Response 

It was expected that for small perturbations the deviations between models 
should be small. Therefore initial conditions of 5° in pitch were tested first. For the linear 
model it is also required to give an initial value for depth change which was defined as: 

Z = -uSin Ü 

Test runs up to 360 sec. in the speed range 5 to 25 Knots were performed 
simultaneously for both models. Maximum differences for each run were obtained from 
data files and given in. Table 1. The pitch and depth behaviors for both models were 


given in Fig. 4-8. 


Table l. INITIAL CONDITION RESPONSE TO $ DEGREE PITCH ANGLE 
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As can be easily seen from the figures and Table 1 all deviations are verv 
small for this initial condition. That means dvnamics for both model are nearlv identical 
for small perturbations. 

In normal operational conditions a submarine never exceeds 20? pitch an- 
gle. But theoretically maximum allowed pitch angle is limited to about 45°. Therefore 
three more runs Were performed with 45° initial prtch to see large perturbation effects 
on system dynaniucs. Simulation results for 45° initial pitch angle are given on Figures 
9-11. Maximum deviations for pitch angle. speed in the z direction and depth are given 
in Table 2. Maximum deviation does not exceed 775 for this case as can be seen in Table 
21 


Table 2. INITIAL CONDITION RESPONSE TO 45 DEGREE PITCH ANGLE 


Pitch Depth 
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Run Speed 
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co 


The deviations between both models for a second set of initial conditions 
are much bigger but still leads to very similar dynamic behavior. This was expected as 


the angle approximation 
St sme (15) 


Is not as valid as for 5? initial pitch angle. In general for both sets of initial conditions 
itis observed that increasing speed tends to increase the deviations between trajectories. 
b. Forced Response 

Both stern and bow planes can be used in different combinations to keep 
the ordered depth and piteh angle. In order to validate the linear model it is required to 
include some control plane commands in the simulation. Since the mechanical limit for 
the planes is about 35^, test runs were performed up to this angle. It is also desired to 
keep the submarine in maximum allowed pitch and depth limits. For the simulation runs 


which are performed only with bow plane, 5. 15 and 35 degree plane angles were applied 


after the first ten seconds. 
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ligure 4. Initial Condition Response Init. Pitch=3 Deg. U=5 Its. 
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Figure 5. — Initial Condition Response. Init. Pitch=5 Deg. U=8 Kts. 
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ligure 7. Initial Condition Response Init. Pitch = 5 Deg. U- 15 Kts. 
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Figure 8. Initial Condition Response Init. Pitch=3 Deg. U=25 Kis. 
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Figure 10. Initial Condition Response Init. Pitch =45 Dee. U=8 Its. 
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Figure IL. Initial Condition Response Huit. Pitch= 453 Deg. U= 12 Kts. 
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Because of the enormous ellect of the stern plane on submarine pitch angle. 
it was concluded to use reverse angles for 30 seconds cach and then to bring the stern 
plane to the neutral condition. 

Maximum deviations were obtained from data files bv a FORTRAN pro- 
gram and given in. Table 5, 4 and 5 for bow planes, stern planes and both planes re- 
Exeetivelv. 

The test simulation results which were obtained with the bow planes, are 
given in Figures 12 through 20. Figures 12, 15 and IS represent small perturbations for 
three different speeds and it can also be observed from Table 3 that maximum deviation 
is not more than 23 ft. for depth and not more than 0.4 degrce for pitch angle. Figures 
ου πα 9 were given for 15 degree bow plane and except for Figure 19 which re- 
presents the simulation with IS Kts. forward speed, the linear model is acceptable. For 
35 degree bow planes, the linear model is valid only for lower speeds as can be seen from 
Figures 14, 17 and 20. 


Table 3. FORCED RESPONSE TO BOW PLANES 
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Figure 13. Forced Response. Bow Plane = 15 Deg. down. U = 5 Kts. 
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Figure 15. Forced Response. Bow Plane = 5 Deg. down. U = 12 Kts. 
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Figure 16. — Forced Response. Dow Plane = 15 Deg. down. U = 12 hts. 
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Figure 17. — Forced Response. Bow Plane = 35 Deg. down. U = I2 hts. 
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Figure 18. Forced Response. Bow Plane = 5 Deg. down, U = 18 Kts. 
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Figure 19. Forced Response. Bow Plane = 15 Deg. down. U = 18 Kts. 
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Figure 20. lorced Response. Bow Plane = 35 Deg. down, U = 18 Mts. 








Therefore the linear model is valid for all speeds for small plane angles. And 
in general, it is possible to sav that for the first 120 seconds the linear model does work 
well enough for large perturbations. In fact it is not verv often that a watch officer 
wants to keep the bow planes full down for more than 120 seconds in a real submarine. 

The test run results which are obtained with stern plane, are given in Fig- 
ures 21 to 29 and Table 4. Similarly, deviations are acceptable for small and medium 
perturbations as can be seen from the figures. The only condition for which the linear 
model can not be accepted as valid, is displayed in Figure 29 which represents 35 degree 
bow planes with 18 Kts. forward speed. This is expected since two important linearizing 
assumption are invalid at this speed and resulting pitch angles are large. As mentioned 
before, the constant speed assumption for large plane angles and the sin(X) = x ap- 


proximation for pitch angle are no longer valid for this run. 


Table 4. FORCED RESPONSE TO STERN PLANES 
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To be able to observe the effects of both planes on deviations between 
models, nine more runs were performed using stern and bow planes simultaneously. For 
each run the same bow and stern plane angles were applied in such a manner so thev 
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ligure 21. Forced Response. Stern Plane = 5 Deg. U = 5 Kts. 
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Figure 22. Forced Resnonse. Stern Plane = 15 Deg. U = 5 ts. 
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Figure 23. Forced Response. Stern Plane = 35 Deg. U = 5 hts. 
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Figure 2-. Forced Response. Stern Plane = 5 Deg. U = 12 Kts. 
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25. Forced Response. Stern Plane = 15 Deg. U = 12 Kts. 
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Figure 26. Forced Response. Stern Plane = 35 Deg. U = 12 Kts. 
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Forced Response. Stern Plane = 5 Deg. U — 18 hts. 
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Figure 23. Torced Response. Stern Plane = 15 Deg. U = 15 Kts. 
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Figure 29. Forced Response. Stern Plane = 35 Deg. U = 18 Kts. 








limitations. Figures were created but not supplied in this study since they are very similar 
to the preceeding results which were obtained using only stern planes. Deviations 
between models for this last set of runs are a little bit larger than the preceeding results. 
Using two sets of planes means more approximations for the linear model and greater 


deviations between linear and nonlinear models-are expected. 


Table 5. FORCED RESPONSE TO BOW AND STERN PLANES 
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Obviously the linear model does not behave like the nonlinear model for 
large plane angles and high speeds. 1 he most important reason for this is the constant 
speed assumption for the linear model. This assumption is no longer valid for large plane 
angles since planes reduce the forward speed of the actual submarine. Since the aim of 


this studv is to validate the linear model for small perturbations, it is achieved for the 


vertical plane. 


2. Validation of the Linear Model on the Horizontal Plane 
A submarme behaves like a surface ship for most horizontal motions. There are 
some diflerences because of its submerged condition and sail structure. The maim differ- 
ence 1s in roll. A submarine rolls to inboard when a rudder angle is applied. Also the 


rudder has a squatting effect on the submarme which makes the submarine to pitch up 


4] 


and dive. Since the linear model assumes that there 1s no cross-coupling between vertical 
and horizontal motion it is not possible to compare the squatting effect with the linear 
model. 
On the horizontal plane, roll and vaw angles and sway speed can be observed. 
Roll and vaw information are displayed on figures and tables for convenienec. Dut the 
swav response is only supplied on tables as deviation between models. 
a. Initial Condition Response 
The simulations were carried out with a certain roll angle as initial condi- 
tion. In order to see the small and large perturbations effects, 5 and 25 degrees initial roll 
angles were chosen and test runs were perlormed at 525.912 9] ane 
Since both models reach a steady state value after about 120 seconds, sim- 
ulations up to 120 seconds were performed, simultancously for both the linear and non- 
linear models. Maximum deviations for each run were obtained from data files and are 


given in Table 6. 


Table 6. INITIAL CONDITION RESPONSE FOR HORIZONTAL PLANE 
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As can be seen from Figures 30, 31 and 32, it is obvious that there is almost 
no deviation on roll response for 5 degree mitial roll angle. There are some slight devi- 
ations for 25 degree initial roll angle and unlike the vertical plane, deviations are de- 
creasing with increasing axial speed. It is to be noted that the approximation bv a linear 
model has not affected the period of rolling. Simulation results are given on Figures 32, 
33 and 34 for 25 degree initial roll angle response. 

Therefore it has been concluded that the linear model on horizontal plane 


is valid for small and large initial conditions. 
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INIT. COND. RESPONSE — INIT, ROLL = 5 DEG 
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b. Forced Response 

The only relevant force beside propellers 1s created bv the rudder on hori- 
zontal plane. The rudder also has an appreciable effect on vertical motion which is called 
the squatting effect. Even though the linear model assumes that there is no cross- 
coupling eflect between vertical and horizontal motion, it was decided to display depth 
and pitch angle changes which were obtained by non-linear simulation for further study. 
Cross-coupling effects which are obtained by non-linear snnulation at dilferent speeds. 
are given in Figures 38, 40, 42, 44, 46, 48 and 50. 

Simulation runs are abtaimed for three diflerent speeds and rudder angles for 
this case. Plots for vaw and roll response are given in. Figures 35-37, 39, 41, 43, 45, 47 
and 49, Maximum deviations are given on Table 7. Again similar deviation behaviors 


can be observed as vertical motion. 


Table 7. FORCED RESPONSE TO RUDDER 
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Ἂς à result of this chapter it has been concluded that approximation by 





linear model is valid for small perturbations at all speeds for both motions. In addition. 
it has been observed that the linearized model is still valid for large perturbations applied 


over a short period of time. 
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figure 36. Forced Response. Rudder = 15 Deg. U = 5 Kts. 
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Figure 37. Forced Response. Rudder = 35 Dee. U = 5 Kts. 
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Figure 39. Forced Response. Rudder = 5 Deg. U = 12 Kts. 
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Figure 47. Forced Response. Rudder — 15 Deg. U = 183 Kts. 
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lll. AUTOMATIC DEPTH AND PITCH CONTROL 


A. DESIGN SPECIFICATIONS 

After a valid lincar model is defined, any type of design method for linear systems 
can be used. It 1s assumed that the submarine which is considered in this study has no 
mertial guidance svstem. That means rate information is not available and the only 
states to be used as feedback are depth. pitch and speed. Due to this limited instrumen- 
tation the controller will have to use cascaded filters. 

Since a submarine maneuvering capability depends highly on the axial speed, it is 
very hard to sausf{v some certain specifications for this kind of control svstems, But 
s it iS acceptable il the control system can achieve 10 {t. depth change in [20 
seconds and Tt depth change in 240 seconds. Also more than 2 feet overshoot is not 
desirable for small depth changes and overshoot must stay within 5^5 for large depth 
changes. Deviation from ordered piteh must stay within 2 degrees. 

Momeme control svstei to be designed, plane angle limits which are about 35 deerces, 
have to be taken into the consideration. A depth and pitch control svstem which requires 
νων, ΙΙ 5 degrees plane angles to get the ordered depth or pitch is clearly not 


realizable. 


B. DESIGN 
The linearized equations of motion for the vertical plane are obtained and given in 


Iupiter ?- Ihey are repeated below for convenience 


22 —].28x10 ^ui —0.706uq -- (0.01283 —1.728107742)0 —6.667x10 7 i^ s 


‘16 
ο οταν] u óh (16) 


Q = 1.884010 v2 —6.365x10 ug —1.465x10 u^ 05 43.193107 ^i) 6b 


5 = 17) 
+ (1.884.010 ο ο lO 3)0 pu 


A signal flow graph can describe the corresponding input/output relations for these 
equations. Inputs will be the bow and stern plane angles and outputs of interest are 
depth and pitch for vertical motion and such a flow graph is given in Vig. Sl where 

a= —3.87x10 4 

b= —].73x10 ^u 

c = —].J465x10 ιο 








Figure 51. Signal Flow Graph for Vertical Equations of Motion 


d= —6.67x10- 41 

e= MI9x10 ^i? 

f 95 —6.36x107u 

g Jas vIOSNe—2: 9910s 
= Όση 

i 0.013 — 1.73x10 72 
k= 1.88x10u 


I. Decoupling 


In order to design a cascade compensator with a single loop technique, one must 
have the independent input-output relations for each input and output [Ref 7] In 
other words it 1s necessary to obtain two transfer functions for depth and two transfer 
functions for pitch which have the stern and bow planes as inputs. 

Applying Mason's gain rule to the signal flow graph given in Vig.44 the input- 


output relations will be as follows [Ref. 8: p. 83]. 
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Substituting the corresponding numbers into these equations 
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Transfer functions which are dealing with depth, have fourth order characteristic 


equations and thev are type one systems with the same denominator. On the other hand, 


transfer functions for pitch are type zero and have third order characteristic equations 


with the same denominator. Also all transfer functions have the same poles except one 


at the origin. So it 1$ expected that they might show similar frequency response and it 


mav be possible to usc onlv one cascade compensator to compansate the whole system. 


In order to make further analysis on thesc transfer functions, the axial speed. u 


has to be defined as a number. It is always possible to design the control system for a 


specific speed and check the validation of design for a certain speed range. Since slower 


Speeds inake it harder to gct desired depth and pitch angle, it is not very efficient to use 


an automatic control for less than 5 Knots. A possible approach would be to use 10 
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ft'sec. ( 5.9 Kts.) as axial speed. If the designed control system works for this speed, it 


will probably work for the higher speeds. 
2. Design 
With 10 ft.'sec. axial speed, transfer functions become 


OD s* e g.09x107 ^s? 40.41 x 1078s? +4.12x107°5 


OS 54. 4.8.09x10775? 40.41 x10 s? +4.12x107°s 


Obs? +8.09x1077s* + 0.41x107 8s +4. 12x107° 





pich E E ime 


OS 5? +8.09x107757 +0.41x1072s +4. 12x107 


It is more convenient to rename these transfer functions such as 








depth 
gils) = "om 
depth 
ςῃ{5 pw ὃς 
pitch 
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]hen the transfer function matrix becomes 


Gb ga (s) Ü 
a 0 £-22(5) 
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(26) 


(27) 


(28) 


(29) 


(30) 


(31) 


(33) 


(34) 


(35) 





The corresponding control] model is sketched in Fig.52. The equivalent transfer 


function matrix will be 


gii)g (5). 212(5)022(5) 
G,, — G(s)G, (s) = 36 
| m Εχι(5}6ε11{5) g22(5)£c22(5) J 


Characteristic equation roots for these transfer functions are given in Table 8. 


Only one transfer function has roots in right half plane which 1s g,,(s). 


Table 8. CHARACTERISTIC EQUATION ROOTS FOR VERTICAL MOTION 


Transfer Function 


-0.392 + 0.188, -0.00] + j0.045 
-0.030 + j0.260, -0.0646, 0.0423 


-0.014 + 10.022, -0.078 
-0.008 + 30.028, -0.065 





]he open loop Bode diagrams and root locus plots are given on Figures 53 to 
60. As expected transfer functions for depth have sinular frequency response with a small 
positive phase margin. Also both of them have root locations on the right half plane. 
On the other hand transfer functions for pitch show similar behavior. They are also 
stable with 50 and 60 degrees phase margin. The onlv transfer function which is stable 
Por all gains 15 g,,(s) as can be seen from Fig. 60. 

l' rom the root locus diagrams one can easily see that, except for g,,(s), the other 
three transfer functions have many root locations on the right half plane which nught 
make the cascade compensation destgn required. Since g,.(s) has characteristic equation 
roots in the right half plane and also the root locus diagram shows one root location 
Pranchetiat extends along the positive real axis, it is clearly unstable. In particular 
g,,(s) might not need any compensation other than a gain adjustment. 

]he effect of bow planes on pitch angle and the effect of stern planes on depth 
are rather small compared to the effect of bow planes on depth and stern planes on 
pitch. So it is considered best to focus on the transfer functions g,,(s) and g,, while car- 
rving out a design procedure. Even if the designed compensators for these two transfer 
funcuons are not satisfactory for the other two equations, the total system response 


night be suffierent. 
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Figure 52. Cascade Compensated Control Model for Vertical Motion 


Since the transfer functions for the vertical plane have poles in the right half 
plane, they do not represent minimum phase systems. For a non-mimimum phase svstem 
it 1s more complicated to achieve a design which meets the required specifications. 
lIowever it is possible to start with a very basic design and improve it after observing 
compensator effects on the svstem behavior. 

From the requirements mentioned before, the settling time will be more than 
1O0 seconds and the damping coefficient ¢ is about 0.5 for sufficient damping. Using the 


formula for second order approximation 


4 


T. = 一 -一 37 
US (37) 
Solving for c, and substituting numbers 
M E ος (38) 
πο ο μυ 


lhe gain crossover frequency for the uncompensated system is about 0.2 


rad’sec. as can be seen from Fig. 54. Then the gain which is to be used for the first 
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Root Locus Plot for g,,(s). 
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compensator, has to be less than one mn order to get the desired response. This gain 
constant is called K1 and taken as 0.1 for the first trial. 
In order to increase phase margin a first order lead compensator ts to be added 
to the forward path. Such a compensator has the form 
Je τ 
G, = (39) 
lg cetiplierpyzs required. to keep error coefficient constant. [Ref. 2 | 
Using cascade compensator design techniques the best choice for the first trial 
enses will be 
ΠΠ (s+ 0.1) 


| 
o E =e — dE 一 一 -一 m 10 
ο ο ου i s+ 1.0 Do) 


Multiplving with KI the total compensator is 


s+0.] 


F a 


The root locus plot and open loop Bode diagram for the compensated svstem 
are given on Fig.l and Fig. 62. The compensated system has about 75 degree phase 
margin Which is obviously more than the specified requirements. This excess phase 
margin may cause a request for the large plane angles which itis not possible to supply. 
Since it is always possible to use limiters on plane angles it is concluded to leave the 
designed compensator as itis and use it for preliminary design procedures. 

o Slice very reasonable well daniped, 110 compensator will be used 
and K2 will be taken as 1.0 for the first trial. 

The next step 1s to put the compensator in the actual linear system and observe 
the response of the svstem. But before doing that the simulation program has to be up- 
ΙΙ Order to ect more realistic results and accuracy. 

a. Limiters 

iceineccnanical tmut for both planerdetecions is 35 dcerce. Dut it is not 
desirable to use full plane angles for higher speeds. Also it is possible to limit planes and 
the error signals. The test runs which are achieved with limited planes led to unaccepta- 
ble plane behavior such as very small deflections. Under these set of circumstances it 


was concluded to limit the error signal such as: 
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‘lim = 35 when u < 15 {t/sec. 
mes a when 15 < u «309p sec: 
lin =15 wic u 50 [[ see. 


Obviously this limiter does not have any effect for less than 15 ft. depth 
changes where there is no need for a limiter. 
b. Actuators 
The linearized model docs not include the dynamics of the plane actuators, 
which are force and moment producers. The actuator dynamics Were ignored tn the 
model comparison part of this study. In order to have an accurate model for the design 
procedure, an actuator model has to be added to the system dynamics. Such an actuator 


model was developed by [Ref. 6 ] and represented as 


l 


=ne j 
s+ 0.667 a 


p = 


The complete model which is used in the simulation program is given in Fig. 


Ordered lim EIN | k. 
—( J Limiter —] —— —— — 


Depth (S*10) LINEAR 





Ordered ° "m MODEL 
2 ---- E ERSA ο 
Pitch EN 5*0.667 ἀν. 





Figure 63. Block Diagram for Compensated Linear Model in Vertical Motion 


à. Simulation 

The simulation program is written based on the discussed subjects above. The 
first run was made with the preliminary. design gains, poles and zeros. Then required 
Semecions Were made in order to meet the design specifications. The DSL simulation 
program with the final parameters is given in Appendix F. 

Test run results which were achieved with different sets of parameters are given 
in Figures 64 to 74. Each run 15 explained briefly below: 

Pun No. I: 

The simulation program was run with the first set of parameters for 10 ft. depth 
change and 10 ft, sec. axial speed which is the Iower limit for this compensation. With 
K1=0.1 the required bow plane angle was verv large and overshoot was 2576. This run 
does not meet the specified requirements. 

ΠΠ νο, ο: 

In order to get reasonable plane response it is decided to reduce KI to the value 
of 0.01. This time the maximum bow plane deflection 1s 26 degree but the time required 
to reach 10 feet depth change is a little longer than the specification. This run is also 
discarded. 

Rainy No. 3: 

A third approach would be to change K1 to 0.015. The result was quite satis- 
factory except the 40 degree maximum bow plane angle. The main reason for this larger 
plane request is the excess phase margin on the system. The one possible wav to reduce 
phase margin is to shift the cascade compensator one decade up m the frequeney do- 
mam. 

Run No. 4: 

Using the new compensator with one zero at 1.0 and one pole at 10.0, the results 
are satisfactory. As can be seen from figure 66 the maximum required bow plane angle 
is 10 degrees, the time to complete 10 ft. depth change is 78 sec. and the overshoot ts 
10°. This excess overshoot is the pavoll for reducing the phase margin but since it 
Miates only one foot difficrence, it is acceptable. 

(πμ νο». 

Meisscesivedl to check the system response for large depth changes. The simu- 


lation program was run for a 100 ft. depth change. Maximum required bow plane angle 





is 34 degrees and overshoot is 5%. At this point it scems that the compensated linear 
model for depth control is acceptable. 

It is also required to check the pitch response of the svstem. Test runs were 
performed with zero depth and some certain. pitch. angle change. Because of tlie bow 
plane effect (which tries to keep the submarine at the same depth) tliere was a steadv 
state error on pitch angle. Since this pitch error relates very closcly to K2, it is concluded 
[ο Increase hoz toe.) 

Runs No.6 and 7: 

To make sure that there is no negative effect on depth behavior of the svstem 
created by the new K2 parameter, two more runs were achieved with K2= 2.0 for 10 and 
100 feet depth change. Since there was only a shght change on overshoot, the new K2 
value 1s accepted and used for further study. 

Run No. § 

In order to check the pitch response of the compensated svstem, a -5 degree 
pitch command was ordered while the depth change command was Zero. System has 
reached the ordered pitch angle in 46 seconds and because of the bow plane elflect. it 
settled on -J degrec. Increasing K2 might decrease this steadv state error but at the same 
time it nught create more overshoot and instability problems on depth behavior of the 
svstem. Smee a 1 degree error ts in the specifications linuts, K2 = 2.0 will be used for 
further study. 

Runs No. 9 and 10: 

The next step is to check the designed system for a certain rangevof speed dion 
15.2 {t.’sec. (9 Kts. ) two runs were performed with rand TOn hane am 
can be seen from Fig.s 69 and 70 there is 12% overshoot for 10 ft. depth change and 3^0 
for ]00 ft. depth change. Increasing the speed has a positive eflect for large depth 
changes while having a negative effect for small ones. 

Runs No. HH and 12: 

The axial speed was increased to 12 Kts. The svstem rcaclies the ordered depth 
in shorter time and has only 2% overshoot for 100 ft. depth change. 

Runs No. 13 and 14: 

Two more test runs were performed with 18 Kts. axial speed. As can be seen 
Irom lig.s 21 and 22 the compensated control model is still valid and, in fact, works 
better with only 1°o overshoot for large depth change. 

| inally it is considered that the designed automatic control for the linearized 


vertical niotion using cascade compensator design techniques is satisfactory and should 
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be checked with actual non-linear model. After designing another cascade compensator 
for the horizontal motion, both models will be checked mn order to see Whether the design 


Pecomimpeted or necds some alterations. 


10 FT. DEPTH CHANGE U = 10 FT./SEC. 
K1=0.1 K2=1.0 


12 


Ë > 
à 
+ 
ους” 
0 100 200 300 
TIME (SEC.) 
K1-0.01 K2-21.0 
o 
Es 
C 
o 
0 100 200 300 


TIME (SEC.) 


Figure GJ. Compensated System Depth Response Z =0.1, P = 1.0 
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Figure 65. Compensated System Depth Response K1 = 0.015, K2 = 1.0 
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Figure 66. 
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Plane Angle Deflections for first and second Compensator 
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Figure 67. Compensated System Response to 100 ft. Depth Change 
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Figure 68. 
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Figure 69. Compensated System Response to 10 ft. Depth Change U=9 Kts. 
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Figure 70. 
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10 FEET DEPTH CHANGE U = 12 KTS. 
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Figure 72. Compensated System Response to 100 ft. Depth Change U= 12 Kts. 
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Figure 73. 
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IV. AUTOMATIC STEERING CONTROL 


Turning characteristics of a surfaced submarine are very similar to a surface ship. 
But the situation in the submerged position shows big differences. Sail structure can be 
considered the main difference and the main source of rolling. But roll control is not 
considered in this study since the mam purpose was to control depth change which is 
caused by the rudder. 

In Chapter 2, three equations of motion were Imearized and derived for the hort- 
Zontal plane. Same equations will be used to design a steering control for a submerged 
submarine. But the algebraic loop problem has to be solved before using Mason's gain 
mule. 


Three linear equations for horizontal motion are 
b= L89; — 6.35 — 0.291ur — 0.035up — 2.563x10 ur + 7.560810 u Sr (43) 


p- —0.679; — 0.05846 — 8.17910? up — 9.347x10 Sur —3.942x 107 aa 


ES 
+ 3.942x 107 Ww br = 0.2360 m 
p2 —6.553x107p 4 6.767x10 7$ — 6767x107 ur —4.51 1x10 up — 4.076x 1077 uv 
| L5 2.4 (45) 
—1.631x10 “wor 


Substituting the highest derivative terms into each equation and after a great deal 


of algebraic work 
r2 —0.437ur 4- 0.027up — 5.06x 10 ^ uv 4 6.49 107^ u^àr — 2.1894 (46) 
p 0.021ur — 9.8x10 up —3.384x10 ^v 4- 1.24910 ^ u^ 6r — 0.378 (47) 
P= —7.2x10 “ur + 7.8x10 up —3.888x 10 uv — 1.595x10 wu’ dr — 4.094107 45. (18) 


A. DESIGN SPECIFICATIONS 


In general, the required time to achieve a course change in a ship depends on 


pd 
. 


The forward speed, 

2. The difference between previous and commanded course, 
3. Applied rudder angle, 
4 


Rudder area, 


2 





5. The length and hull structure of the ship. 


The submerged condition is also a very important aspect since the required turning 
time 1s about three mes greater for a submerged submarine than a surfaced one. LEspc- 
cially at lower speeds, it is very hard to achieve the desired course [or a submerged sub- 
marince. 

It is concluded that for the speeds which are less then 10 Kts., a control svstem must 
achieve every 10 degrees course change in 30 seconds. This allows 9 minutes to complete 
a 180 degrees turn and it 1s very reasonable for a low speed submerged submarine. For 
higher speeds this time limit would be 20 seconds. It 1s also considered that more than 
2.5 degrees overshoot 1s not acceptable. 

The mechanical limit angle for rudder is also 35 degree and has to be considered in 


the design process. 


B. DESIGN 

The cascade compensation method will be used for the horizontal motion. Since the 
aim of this chapter is to design a basic steering control, the roll response will not be in- 
vestigated. The yaw response to the rudder is the only input-output relation of interest 
at this point. Figure 75 represents a control model for the horizontal motion. 

A signal flow graph is given on Fig. 76 for the linearized equations of horizontal 
motion. The corresponding numbers for svmbols in the flow graph are given below: 

a — 0.437u 

Dr 

c = —5.0x107*u 

ποτ ος 

e = —2.39 

PDF, 

g=—-—9.8x103u 

h = —3.4x10-4u 

EAO e 

j = —0.378 

k= —],2x1031 

| 2 —7.8x10-u 

m = —39x1075u 

n = —].6xl0-*u 

o = —4.1x10^? 
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Figure 75. Cascade Compensated Control Model for Horizontal Motion 


1. Decoupling 
Since this signal flow graph creates 13 loops to be handled, it is considered to 
take u as 10 ft./sec. at the beginning of the calculation in order to reduce the amount 
of required algebraic work. 
Applying Mason's gain rule to the signal flow graph given in Fig.76, the input- 
output relation for yaw will be as follows 


K U| o e aO E o SS 
JON = Gy = miedo s Saxo 888 = 6S0. (49) 
Or 


s° +0.175s° 4-0.38855" 4-0.0225? —5.77x10 7s 
In factorized form. the same equation will be 


s —].Gx10 "(s 4- 0.1176 -- j0.6222)(s 4- 0.1376 — j0.6222Y(s -- 0,102) me 
P7 s 4- 0.0587 4- JU.6152)(5 4- 0.0587 —J0.6152)5 - U.0602)5 — U.0025] ©) 
As can be seen from the transfer function, there is a real pole in the right half 
plane which is very near to the origin. The characteristic equation roots are 
—).058+/0.615 
—0.018--/0.020 
—0.1 


—0.022 


29 





Figure 76. Signal Flow Graph for Horizontal Equations of Motion 


The root locus plot and open loop Bode plot for G, are given m Fig.s 77 and 
78. 
The root locus płot shows that there 15 a very small gain range where the system ıs sta- 
ble. The Bode plot also agrees that the system is unstable with 15 degrees negative phase 
margin and there really is a small gain range over which the system will be stable with 
a small damping. 

Since it is obvious that a gain adjustment will not be enough to get the desired 


response out of the system, the cascade compensation will be required. In order to 
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increase phase margin a first order lead compensator is to be added to the forward path. 


Using cascade compensator design techniques, the first trial would be 


O1 st001 50.01) 


CT n s - 0.1 $915 
There will be no gain adjusment at this port. 

The Bode plot for the compensated svstem is given in Fig. 79. The phase margin 
is 40 degrees and that 1s about the maximun phase which can be acquired with only one 
cascade compensator. The root locus plot shows that the compensator has moved a lot 
of root locations to the left half plane and it 1s given in Fig. 80. 

Since the root locus and Bode plots show very reasonable damping and stability, 
itis considered that the compensated system is ready for the simulation. The DSL sim- 
ulation program which ts used for the validation of the linear model (Appendix E), is 
updated with the designed cascade compensator. This program is given in Appendix G 
including required modifications. 

2. Simulation 

The same plane actuators which were used for the stern and bow planes, are 
used for the rudder in the simulation program. But since the input is totally different, it 
is necessary to design a different criteria for the limiter. The first run was made without 


anv limiter, then using trial and error, the best limiter choice ts appeared to be: 


lum = 0070 Wien u < J 2 Γι. 
lim — (050 when 2 < uú =< IS SU 
lim 20.033 demus hu 


The complete model which is used in the simulation program is given in Tig. 81. 

lest run results which were achieved with dilTerent sets of speed and course, are 
given in Figures $2 to 90. The roll response is also given in order to make sure that 
submarine does not exceed maximum allowable roll limits. Each run is explained briefly 
below: 

Run No. 1: 

Lsing 6 kts. forward speed and [O degrees course change, the maximum rc- 
quired rudder angle was 82 degrecs. Therefore it is necessary to use a limiter on the error 


signal. 
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Figure 81. Block Diagram for Compensated Linear Model in Horizontal Motion 


Run ὅν» 

Using the limiter which was mentioned above and for 15 degrees course change, 
the maximum required rudder was 33 degrees. It takes 46 second to get 15 degrees course 
alteration with only 2.5% overshoot. 

[Sun Nod 

This time the system is tested with the same speed for a 90 degree course change 
which is one of the commonly used commands in a submarine. It takes 214 sec. to ex- 
ceute this command whieh 1s in the specified limits. The overshoot is 1.5% and maxt- 
mum required rudder angle 1s also 33 degrees. 

Run No. d: 

In order to get the speed range in which the compensated system stays in the 
required specifications, the forward speed is increased to 10 Kts. For a 15 degree course 
change the time to execute the command is 22 scc with 1.9 feet overshoot. 

Run No. 3: 

lor 90 degrees course change with 10 Kts. forward speed the time to execute the 
command is 103 see. with 1.5% overshoot. Maxnnum required rudder angle is still 33 


degrees. As can also be seen from Fig. 86 the maximum roll is about 3 degrees. 
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Runs No.6 and 7; 

These runs were made with [5 kts. forward speed for [5 and 90 degrees course 
ος W hile the required time decreases with increasing speed, the overshoot in- 
creases. But the results are sull in the specification limit as can be seen from Fig.s 87 and 
88. Ihe maximum roll angle is 5 degrees for I5 Kts. forward speed which is also rea- 
sonable. The maximum required rudder angle is 23 degrees for this case. 

Runs No. 8 and 9: 

These runs were made with 20 Kts. forward speed also dictated the speed range 
for the compensated system because it becomes too oscillatory after 20 Kts. which ts not 
desirable. It is necessary to add another cascade compensator to the forward path in 
order to get enough damping for speeds higher than 20 kts. It 1s to be noted that using 
a limiter also helps to keep the roll angles small. In this case the maximum rudder angle 
is only 16 degrees because of the limiter effect. With this limited rudder angle the maxi- 
mum roll is only 8 degrees. Even though it is not intended to control the roll. the limiter 
supplies an indirect control on the roll response. 

Finally it 15 considered that the designed automatic control for the linearized 
horizontal motion using cascade compensator design techniques, is satisfactorv for the 
speed range of 6 to 2U Kts. This design should be checked in the actual non-linear sys- 


ten. 
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ORDERED YAW = 15 DEGREES — U = 10 KTS 
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Figure 83. Yaw and Roll Response to 15 Degree Course Change. U = 10 Kts. 
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figure 89. Yaw and Roll Response to 15 Degree Course Change. U = 20 Kts. 
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V. VALIDATION OF THE COMPENSATED NON-LINEAR MODEL 


The maim purpose of this study was to show that it is possible to design a 
compensator based on the lincarized. version of a non-linear model and then to com- 
pensate the actual non-linear model with this designed compensator. In the previous 
chapters the required compensators were designed for the linear models on vertical and 
horizontal motions. These compensators had to be checked with the actual non-linear 
model to see that the system will really work with them. 

The complete DSL simulation program for the non-lincar model was already written 
and used by Ref. 3 and Ref. 5. It 1s also used for this study to compare linearized models 
with the non-linear model. In order to check the validity of automatic control svstems, 
the DSL simulation program 1s to be modified including the compensator and limiter 
algorithms in it. The modified version of the DSL program for the compensated non- 


linear model is given in Appendix I. 


A. SIMULATION 

lor the test runs to check the designed compensators, the same limiter values are 
used. Since the actual and commanded velocities ( U and UC ) are two different pa- 
rameters and U is alwavs somewhat less then UC, it is concluded to take actual speed 
U as the parameter for the limiters. This will give more accurate plane deflections de- 
pending on actual forward speed. 

The non-linear snnulation program was run at 6, 10, 12, 15 and 20 Kts. for various 
depth, pitch and vaw commands. A diving submarine can give hundreds of maneuvei 
variations in three dimensional motions. Since it is not possible to include all of them: 
onlv the most common commands and the commands which were used in Chapter 2.3 
and 4 are included for comparison purposes. 

Bhce values for the ordered speed are carefully calculated from Ref. 5 and im- 
plemented in the non-hnear model. 

Test run results which were achieved for different sets of speeds and commands are 
End eures9Tto 106. Each run is explained bricily below: 

Runs No. 1-4: 

The snnulation program was run for 10 and 100 ft. depth changes at 6 Kts. com- 
manded forward speed. As can be seen from Vig. 91 the non-linear model completes a 
10 ft. depth change 10 sec. after the Imear model does. It completes a 100 ft. depth 


(17 





change 20 sec. after the linear model and overshoots for both case are on the specilica- 
tion limits. There is also a 1 [t. steady state error for both cases. 

At the same speed the simulation program was run for 15 and 90 degree course 
changes. ἃς can be seen from Fig. 92 the non-linear model takes about 100 seconds to 
achieve a 15 degree course change with no overshoot and a shght undershoot. Also the 
required time to make a 90 degree course change is more than 360 seconds for the non- 
linear model. These two case are also non-acceptable. 

The main reason for this failure is the decreasing forward speed due to the planc 
deflections. The forward speed, depending on the amount of the rudder deflection, ac- 
tually drops up to 4 Kts. while achieving a course change maneuver. The same thing also 
happens for a depth change maneuver due to the stern and bow planes. The 
compensators werc designed for actual 6 Kts. and higher speeds and they do not mect 
the specifications for less than 6 Kts. forward speed. 

Under these circumstances no more investigations were made at 6 Rts. At this point 
itis concluded to operate at 10 Κις. 

Runs No. 5-8: 

As can be scen m big. 93 the non-linear model completes a 10 ft. depth change in 
42 seconds with | ft. overshoot at 10 Kts. It completes a 100 ft... depth change in. 106 
seconds with 3.5°o overshoot. These numbers satisfied the required specifications and 
they are nearly the same as for the linear model with a little time lag. 

As can be seen in Fig. 94 the non-linear model makes a 15 degree course change in 
25 seconds with 0.8 degree overshoot which is less than the Imear case. lor a 90 degree 
course change the time is 205 seconds with no overshoot. Again due to the rudder drag 
force, the time to reach the commanded course ts much larger but more realistic than the 
linear ease. Since the constant speed assumption which is used for the linear model is 
no longer valid for large perturbations, this is really expected. On the other hand the 
designed cascade compensators can still control the actual non-linear svstem effectively 
cnough and in fact, with less overshoot which is very important from the point of this 
study. 

Kuns SOSA? 

In order to have an idea about speed deviation due to the plane deflections, four 
runs were performed for 10 and 100 feet depth change and 15 and 90 degree course 
change at 10 Kts. As can be seen im lig. 95 λος Ἱς απ αρ s b R s o L 
the drag forces created by rudder and bow, stern planes. This ts expected since the rudder 


has a lot more surface than the other planes. l'or a 15 degree course change the forward 





speed drops abruptly to 9.3 Kts. and goes back to it’s original value in a relatively small 
time. For a 90 degree course change. the forward speed drops up to 9 Kts. and stavs al- 
most constant for about 150 seconds which rs the greatest cause for the slower course 
change rate. 

Runs No. 13 and 14: 

Since the linear model assumes no cross-coupling between vertical and horizontal 
motion, these runs are performed only for the non-linear model. Cross-coupling effects 
on depth and pitch angle are shown tn Fig. 96 at 10 Kts. for 1S and 90 degree course 
change commands. For both commands, the submarine stays in the 5 feet depth and 2 
degrees pitch error Imitations. 

7ο. Ι5: 

One of the most difficult maneuver for a submarine is to change depth while 
achieving a course command. Results of such a maneuver are given on lig. 97 and big. 
98. ^ simulation run for simultancous 90 degree course and 100 ft. depth change com- 
mands, shows that the time to reach 90 degree course change 1s about 40 seconds longer 
than the usual condition but it does not affect the depth change. Because of the rudder 
ellect onlv a small depth error appears until the submarine settles on the desired course. 

As can be seen in Lig. 98 the non-linear submarine's roll and. pitch responses are 
somewhat non-regular but still in reasonable limits for this case. The forward speed de- 
Viation due to the plane drag forces ts also given in Fig. 98. Speed drops up to 5.3 Κίς. 
and this gives an explanation for lower course change rate. 

Asa result for this run, even though the designed control systems interact, thev can 
work well simultaneously. 

τ NO. 16 and 7: 

In order to be able to compare fixed rudder effects on depth and pitch angle. two 
simulations were performed for 15 degree and 35 degree fixed rudder commands in the 
same fashion as in Chapter 4 at 12 Kts. l'or 15 degree rudder the piteli and depth errors 
stav in specified limits but for 35 degree rudder these errors are not allowable. Simulation 
gesulrsdlor this casesare eiven in Fig. 99. 

Runs No. 18 and 19: 

Figure 100 gives the simulation results for a 15 and a 90 degree course change at 15 
Kts. for both linear and the non-linear models. The yaw response for 15 degree course 
change is almost the same as the response for 10 Kts. with a little more overshoot and 
oscillation. On the other hand the non-linear model shows a better response with less 


overshoot for both cases. 
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Runs No. 20 and 21: 

Figure 10] gives the simulation results for a 10 and a 100 feet depth change at 15 
Kts. Surprisingly there is almost no difference between linear and non-linear model for 
the 10 feet depth change. But for the 100 ft. depth change the non-linear model has a 
faster response than the linear model. This 1s unusual and created by different Imuter 
behaviors on bow planes at this specific forward speed. 

Runs No, 22 and 23: 

In a real submarine a depth change command usually comes with a pitch command 
in order to reduce the time to get the desired depth. Figure 102 gives the results of such 
a command for 100 feet depth change with 5 degree down pitch angle at 6 and 15 Kts. 
For both cases the submarine reaches the desired depth 35 seconds before the case for 
Which no pitch command ts given. But as a trade-off the overshoots are over 10%. Also 
the pitch command has to be reduced to zero before the desired depth is reached in order 
to avoid too much overshoot and a steady state error on depth. This ts done 10 feet 
before the desired depth is reached. for 6 Kts and 50 feet before for 15 Kts. 

Runs No. 24 and 25: 

Finally the compensated non-linear system was checked at 20 Kts. Fora 1S anda 
90 degree course change, the yaw responses of the compensated submarine are given in 
Fig. 103, Once again the non-linear model gives a better but slower response then the 
linear model. For the 15 degree course change the yaw responses of both models become 
too oscillatory due to the high speed. But the compensator still works well enough to 
control the submarine. 

Runs No. 26 and 27: 

Figure 104 gives the compensated submarine depth responses for a 10 and a 100 feet 
depth change at 20 Kts. There is a 0.8 feet steady state error for both cases which ts 
created by the system dynamics due to the high speed. The control system design 15 
based on 10 ft./sec. ( 6 Kts.) forward speed. At 20 Kts. the transfer functions which 
describes the submarine dynamics might have very diflferent characteristics. Conse- 
quently it is concluded that the upper speed limit for this design 1s 20 kts. In fact, the 
control system works up to 25 Kts. without exceeding design specification limits. 

Ihe compensated submarine pitch responses for the same runs are given in Fig. 105. 
Ihe linear and non-linear models show very similar pitch behavior and pitch angles do 
not exceed the given 2 degree limit even for this high speed. 

As à result of this chapter it has been shown that the designed automatic control 


system for the linearized model can also work effectively on the actual non-linear model. 
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Figure 91. Compensated Subinarine Depth Responses at 6 Kts. 
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Figure 92. Compensated Submarine Yaw Responses at 6 Kts. 
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Ligure 94. Compensated Submarine Yaw Responses at 10 Kts. 
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Figure 96. — Cross-Coupling Effects for the Non-Linear Submarine at 10 Kts. 
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Figure 97. Course and Depth Change Commanded at the Same Time UC= 10 Kts. 
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Figure 98. — Roll, Pitch and Speed Response for Multi-Manevuer Submarine. 
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Figure 99. Depth and Pitch Response for Fixed Rudder Commands U= 12 Kts. 
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Compensated Submarine Depth Responses at 15 Kts. 
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VI. CONCLUSIONS AND RECOMMENDATIONS FOR FURTHER 
WORK 


A. CONCLUSIONS 

The linearization of given non-linear differential equations of motion in six degrees 
of freedom, designing two automatic control systems using cascade compensator design 
techniques for vertical and horizontal motion of a submarine and finally investigating 
cross-coupling effects due to the rudder deflections were the main concerns in this study, 

It has been shown that using linearized equations to design an automatic control for 
the actual non-linear svstem is possible for the submarine problem. Also cascade com- 
pensation, using a single loop technique, which was mainly the Bode plot design in this 
study, 1s possible and practical for automatic pitch, depth and yaw control of small 
submarines. 

The designed control systems for both planes satisfied the design specifications for 
a speed range from 8 to 20 Kts. That means the compensated system 1s rather insensitive 
to speed deviations. Therefore all problems related to gam switching. lke cluttering and 
discontinuities in plane angles. are avoided. This is especially important because the 
forward speed changes significantly during maneuvers. 

The implementation of the designed compensators mto hardware has the following 


desirable features: 


I. Minimal Instrumentation: Since rate information is not required, no inertial guid- 
ance system 15 necessary. Only a regular gyro for course and simple sensors for 
depth and pitch angle are needed. 

2, Low Cost, Weight and Size: The simpheity of the compensator transfer functions 
makes them easily realizable in physical hardware at low manufacturing cost. 
Weight and size requirements are very small, another important factor especially 
for small coastal submarines. A wide speed range is covered by one fixed 
compensator and no changes in parameters are necessary. 

3, Rehabihtyv: The automatic controller can be realized with a set of physical com- 
ponents with a well known high reliability. High component reliability and a small 
number of components wil generally result ina high system reliability. 


B. RECOMMENDATIONS FOR FURTHER WORK 
l. The designed control system in this study can keep the pitch and depth errors in 
rcasonable limits for small rudder deflections and course changes. But larger deflections 


sull create an appreciable amount of depth and pitch error at high speeds which is not 


136 


desirable for near surface operations. It might be worthwhile to miprove this design to 
get a sufficient control on cross-coupling effects for all kinds of heavy maneuvers. This 
can be done using diflerent sets of parameters for the compensators and limiters and or 
Increasing the numbers of compensators for the vertical control of the submarine. 

2. In some operational conditions it ts very important to reach a desned depth as 
soon as possible in a submarine. Therefore an additional pitch angle command is given 
which has an enormous effect on depth change rate. For the present design it is possible 
to give both depth and pitch command at the same time but the watch officer has to 
decide where to change the pitch command to zero. Otherwise, depending on the forward 
speed and commanded pitch angle, the submarine might not stay on desired depth. 

The present design can be modified using a new algorithm which can decide where 
and in what fashton to decrease the pitch angle automatically in order to get desired 


depth and stav there without any unacceptable overshoot and steady stute error. 
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APPENDIX A. DEFINITIONS OF SYMBOLS 


DEFINITION 


A dot over anv symbol signifies differentiation 


with respect to time. 
Buoyancy force which is positive upwards. 


Mass of the submarine including the water m the 


free floating spaces. 
Overall length of the submarine. 


lonear velocitv ol oigo Ng Ed ο ον 5 


toan carth-Gxed asis system 
Component of U along the bod» x-axis. 
Component of U along the body y-axis. 
Component of U along the bodv z-axis. 
Command speed. 


Longitudinal axis of the body fixed coordinate 


axis System. 


Transverse axis of the body fixed coordinate 


axis system. 


Vertical axis of the body fixed coordinate axis 


svstem. 
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Yo 


~ 


f 


Ob 


Distance along the x axis of an earth-fised 


axis system. 


Distance along the y axis of an earth-fixed 


axis system. 


Distance along the z axis of an earth-fixed 


axis system. 


Component of angular velocity about the bodv 


fixed x-axis. 


Component of angular velocity about the body 


fixed y-axis. 


Component of angular velocity about the bodv 


fixed Z-axis. 


The z coordinate of the center of buovance 


( CB ) of the submarine. 

Angle of attack. 

Angle of drift. 

Deflection of bow or fairwater planes. 
Deflection of rudder. 

Deflection of stern planes. 

P πο 

Ihe rato o: 


Pitch angle. 
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TE 


All K's 


zH Ís 


Yaw angle. 

Roll angle. 

Mass density of sea water. 

Weight of water blown from a particular 
ballast tank identified by the integer assigned 
to the mdex i 

Angular velocity. 

]nne. 

Location along the bodv x-axis of the center 
of mass of the i" ballast tank when this tank is 
Med Nith sca naer 


Propulsion force. 


Moment of inertia of a submarine about the 


προς. 


Moment of inertia of a submarine about the 


Y-AXIS. 


\Nfoment of mnertia of a submarine about the 


ση ss 


Non-dimensional constants each of which is assigned 
to a particular force term in the equation of motion 
about the body x-axis. 

Non-dimensional constants each of which is assigned 
to a particular force term in the equation of motion 


about the bodv v-axis. 
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All RE 


ΙΝ 5 


All Y s 


All Z's 


Non-dimensional constants each of which is assigned 
to a particular force term in the equation of motion 


about the body z-axis. 


Non-dimensional constants each of which 1s assigned 
to a particular force term in the equation of motion 


along the body x-axis. 


Non-dimensional constants each of which is assigned 
to a particular force term in the equation of motion 


along the body y-axis. 
Non-dimensional constants each of which is assigned 


to a particular force term in the equation of motion 


along the body z-axis. 
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HYDRODYNAMIC COEFFICIENTS OF SIMULATION 


A. AXIAL FORCE 


-0.000200 
-0.0001 50 
0.0 

-0.002500 
0.0 


B. LATERAL FORCE 


QE 

0.000090 

0.007500 
-0.000700 
-0.021000 

0.0 

0.0 


C. NORMAL FORCE 


-0.001500 
-0.007500 
-0.004500 
-0.000 100 
-0.01 1000 

0.0 

0.0 

0.0 


EQUATIONS 
ARR — -0.000090 
AVR 0.011000 
XVV = (0.006500 
ADBDB = -0.002600 
ΧΡΕΩΝ = 0.0 
3150 = 0.000200 
YVDOT = -0.011000 
YR = 0.003000 
YUU = 0.0 
YDR = (0.006200 
YRN = 0.0 
YDRN = 0.0 
ZRP = -0.000900 
ZVR = .0.008000 
ZQDS = 0.0 
ZVV = (0.000650 
20. = -0.005000 
ZWW = 0.0 
ZWN = 0.0 
Z+VP = 009 
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XRP 
XWQ 
XDRDR 
XVVN 
DSN 


YPDOT 
YV/R/ 
YRDR 
Y V/V/ 
ΤῊ 
ΥΥΝ 


ZQDOT 
ZW. Q 
ZVP 
ZW/W; 
ZDB 
ZVS 
ZWAWN 


0.000250 
-0.007500 
-0.002500 

0.0 

0.0 


-0.000300 

-0.007300 
0.0 

-0.060000 

-0.065000 
0.0 


-0.000200 
-0.006000 
-0.007000 
-0.030000 
-0.002500 
0.0 
0.0 





D. ROLLING MOMENT 


ΤΡ 
KRDOT 
KR 

EV y; 
KWV 


| 


| 


lI 


-0.0000008 


-0.000007 
-0.000040 
-0.000900 

0.003500 


E. PITCHING MOMENT 


F. 


MRR 
M+ RP 
M;W;Q 
MVP 
ΜΝ) 
MDB 
MQN 
MDSN 


NPQ 
NVDOT 
NR 
NUU 
NDR 
NVN 


G. OTHERS 


Al 
LC 
IN 


lI 


-0.0005500 


0.0 
-0.002000 

0.000900 
-0.005000 

0.000500 

0.0 

0.0 


YAWING MOMENT 


-0.000-1000 


0.000300 
-0.003000 
0.0 
-0.003000 
0.0 


-0.00 1000 
415.0 


ΠῚ 


KQR 
KVDOT 
KP 

KV 


MRP 
MWDOT 
MQ 
MUU 
MW 
M/W/ 
MWN 


NPDOT 
AR 
NRDR 
WV V) 
ν᾽ 
NVAVN 


ML 
p 


| 


-0.000100 
-0.000250 
-0.000035 
-0.000 700 


0.000150 
-0.000200 
-0.002500 

0.000040 

0.005000 

0.0 

0.0 


-0.00000 7 

-0.004500 
0.0 
0.014000 
0.015000 
0.0 


-0.0009 50 


0.008 7445 


KPDOT 
KWP 
KUU 
KDR 


MQDOT 
MVR 
MQDS 
MVV 
MDS 
MWW 


MWAWN= 


NRDOT 
JS AV | 
NP 

NV 
NRN 
NDRN 


A3 
BZB 


ΤΕ 
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-0.000003 
0.000250 

0.0 
0.0000 70 


-0.000400 

-0.002000 
0.0 
0.015000 

-0.002500 

0.0 

0.0 


-0.000500 


— -0.000200 


| 


-0.000005 

-0.007500 
0.0 

0.0 


0.001950 
0.00101 14 
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APPENDIX C. STANDARD EQUATIONS OF MOTION 


A. AXIAL FORCE 


PEE ui ; : 
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B. LATERAL FORCE 


p 
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C. NORMAL FORCE 
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D. ROLLING MOMENT 


p T ` o 
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+ Bz, sind cos 0 
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E. PITCHING MONIENT 
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ΓΕ. YAWING MOMENT 
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G. AUNILARY EQUATIONS 


b = p+ jJ sin 0 


ü q — V cos 0 sin $ 


: cos o 


r + Ü sin $ 
cos ó cos 0 


m 


Xə = u cos 0 cos y -- v( sin sin 0 cos y — cos $ sin y) 


+ w( sin $ sin y 4- cos $ sin 0 cos y) 


Jo = u cos 0 sin jj + v(cos $ cos y + sin $ sin 0 sin y) 


+ u( cos @ sin Ó sin y — sin $ cos y) 


Zo = —u sin 0 + v cos 0 sin ó + w cos 0 cos $ 


(Flp = Τι ua 十 (4) + an^ ] 


APPENDIX D. SIMULATION PROGRAM FOR LINEARIZED 


VERTICAL EQUATIONS OF MOTION 


Ἂς THIS PROGRAM SIMULATES THE LINEARIZED SUBMARINE EQUATIONS 
3 IN THE VERTICAL PLANE. 

ot 

a 


TITLE SUBMARINE EQUATIONS FOR THE VERTICAL PLANE 


* AXIAL SPEED 

CONST U=8. 445 

INITIAL 
DS=0. 0 
DB=0. 0 

DERIVATIVE 
DB-0. O*STEP(0) 
DS=0. O*STEP( 0) 
THETA=INTGRL( 0. 08726,Q) 
DEPTH = INTGRL(. 0,ZDOT) 
Q=INTGRL(. 0,QDOT) 
ZDOT=INTGRL( -0. 736, ZDDOT) 
Y1=-1. 728E-3*U*ZDOT 
Y4=-0. 706*U*Q 
Y5=(0. 0128-( 1. 728E-3)*U*U)*THETA 
Y22-6.667E-4*U*U*DS 
Y3--3. 873E-4*U*U*-DB 
ZDDOTsY1-Y24Y34Y44Y5 
YO=1. 884E-5*U*ZDOT 
Y9=-6. 365E-3*U%*Q 
Y6-3. 193E - 6'*U*U*:DB 
Y72-1.465E-5*U*U*DS 
Y8z((1.884E-5)*U*U-2. 522E-3)* THETA 
QDOT=YO+Y8+Y6+Y7+Y9 
DEP=INTGRL(. 0, ZDOT) 

CONTROL FINTIM=360 

PRINT 1. ,THETA,DEPTH,ZDOT 

SAVE 0.1,W,ZDOT,THETA,DEP 

GRAPH( DE=TEK618)TINE, THETA, DEP 

LABEL INITIAL CONDITION RESPONSE IN. PITCH=5 DEG. ^ U-5 KTS. 

GRAPH(DE-TEK618)TIME,ZDOT 

LABEL INITIAL CONDITION RESPONSE IN.PITCH-5 DEG. U=5 KTS. 
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APPENDIX E. SIMULATION PROGRANI FOR LINEARIZED 


HORIZONTAL EQUATIONS OF MOTION 


Ὗς THIS PROGRAM SIMULATES THE LINEARIZED SUBMARINE EQUATIONS 
τς IN THE HORIZONTAL PLANE. 

σς 

Fr 

ος 


TITLE SUBMARINE EQUATIONS FOR THE HORIZONTAL PLANE 


* AXIAL SPEED 

CONST U=30.4 

INITIAL 
DR=0. 0 

DERIVATIVE 
Y1-1. 89*RDOT 
Y2--6. 3*PDOT 
Υ9--0. 29 1*U*R 
Y4--0. 035*U*P 
y5--2.563E-23*U*V 
Y6=7. 568E-4*U*U*DR 
VDOTzY14Y24Y34Y44Y54Y6 
Y7-2-0. 679*RDOT 
Y8--0. 0584*VDOT 
y9--9.347E-3*U*R 
Y10z-8.179E-3*U*P 
Y11=-3. 942E-4*U*V 
Y12723. 942E-5*U*U*DR 
Y13-20.236* PHI 
PDOT=Y7+Y8+Y9+Y10+Y11+Y12-Y13 
Y14=-6. 553E-3*PDOT 
Y15=6. 767E-4*VDOT 
Y16=-6, 767E-3*U*R 
Y172-4.511E-6*U*P 
Y18z-4.076E-5*U*V 
Y19--1. 631E-5*U**U* DR 
RDOT=Y 14+Y15+Y16+Y17+Y18+Y19 
P=INTGRL(.0,PDOT) 
V=INTGRL(. 0, VDOT) 
R=INTGRL(.0,RDOT) 

* PHI=INTGRL( 0. 43633,P) 
PHI=INTGRL(0. 0,P) 
XI=INTGRL(. 0,R) 

DYNAMIC 


IECTINE GE ΠΠ ΠΕ ΟΠ 
ΙΕ(ΤΙΗΕ. GE 40) DR = -0. 611 
IF(TIME.GE.70) DR = 0.0 


DRDEG = DR*57. 296 

ROLDEG= PHI*57.296 

YAWDEG= XI*57. 296 
CONTROL FINTIN=360 








PRINT 1. ,V,YAWDEG,ROLDEG 

SAVE tat, V¥;, YAWDEG .ROLDEG ,DRDEG 

GRAPH( DE=TEK618)TINE , YAWDEG, ROLDEG 

ΠΠ FORCED RESPONSE TO 35 DEG. RUDDER U=18 KTS. 


L 
C 
UU 


APPENDIX F. SIMULATION PROGRAM FOR THE COMPENSATED 


SYSTEM IN VERTICAL MOTION 


>: THIS PROGRAM SIMULATES THE COMPENSATED SUBMARINE MOTIONS 
IN THE VERTICAL PLANE. 

ye 

TITLE SUBMARINE SIMULATION 
PARAM K1 = 0.015 

PARAM K2 = 2.0 

PARAM UC = 10.4 

PARAM ZOR= 100. 


PARAM POR= 0.0 


DERIVATIVE 
PITCH=INTGRL(0. 0,Q) 
DEPTH = INTGRL(.0,ZDOT) 
Q=INTGRL(. 0, QDOT) 
ZDOT=INTGRL( -0. 736, ZDDOT) 
Y1=-1. 728E-3*U*ZDOT 
Y4--0. 706*U*Q 
Y52(0.0128-(1. 728E-3)*U*U)* PITCH 
Y2--6.667E-4*U*U*DS 
Y32-3.873E-4*U*U*DB 
ZDDOTsY14Y24Y34Y44Y5 
YO=1. 884E-5*U*ZDOT 
Y9--6. 365E-3*U*Q 
Y6-3. 193E- 6*U*U*DB 
Y7=-1. 465E-5*U*U*DS 
Y8=((1. B84E-5)*U*U-2. 522E-3)* PITCH 
QDOT=YO+Y8+Y6+Y7+Y9 
DEP=INTGRL(. 0,ZDOT) 
ZER = ZOR - DEPTH 
PER = POR - PITCH 
ZERR= LIMIT( -LIM, LIM, ZER) 
PERR= LIMIT(-LIM, LIM, PER) 
DYNAMIC 


ΙΡ ΤΡΙ NEIN 35. 
Πο ο Ες μι 555 
DBOUDSOES 5. ) DIN SI. 


*COMPENSATOR Geli 


C11 = -K1*ZERR 
Go Us ROOT 
DB - REALPL(O. ,. 667,C12) 
*COMPENSATOR GC22 
C21 = -K2*PERR 
DS = REALPL(O. ,.667,C21) 
DSDEG = 57. 296"DS 
DBDEG = 57. 296**DB 





PITDEG = 57. 296*PITCH 

CONTROL  FINTIN=360 

SAVE 0.1,DEPTH,ZDOT,PITDEG,DSDEG ,DBDEG 
PRINT 1. ,PITDEG,DEPTH, ZDOT,DSDEG,DBDEG 
GRAPH( DE=TEK618)TIME, PITCH, DEPTH 

LABEL 100 FT. DEPTH CHANGE U=6 KTS. 
GRAPH ( DE=TEK6 18) DBDEG , DSDEG 

LABEL 100 FT. DEPTH CHANGE  U=6 KTS. 





APPENDIX G. SIMULATION PROGRAM FOR THE COMPENSATED 


SYSTEM IN HORIZONTAL MOTION 
* THIS PROGRAM SIMULATES THE COMPENSATED SUBMARINE MOTIONS 


xc IN THE HORIZONTAL PLANE. 


3€ 
9c 


[ΠΠ 


PARAM 
PARAM 
PARAM 
PARAM 


SUBMARINE SIMULATION FOR THE HORIZONTAL PLANE 


1. 00 
LIM = 0.065 
U 30.4 
ORYAW=0. 2618 


Kl 


DERIVATIVE 


DYNAMIC 


Y1=1. 89*RDOT 

Y2--6. 3*PDOT 

Y3=-0. 291*U*R 

Y4=-0. 035*U*P 

Y5=-2. 563E-3*U*V 
Y6-27.568E-4*U*U*DR 
VDOT2Y14-Y24Y34Y44Y5-Y6 
Y7--0. 679* RDOT 

Y8=-0. 0584*VDOT 

Y9=-9. 347E-3*U"R 
¥10=-8. 179E -3*U*P 
Y112-3.942E-4*:0*V 
Y12-3. 942E -5*U*U*DR 
Y13-0. 236* PHI 
PDOT=Y7+Y8+Y9+Y10+Y11+Y12-Y13 
Y14--6.553E-3*PDOT 
Y15=6. 767E-4* VDOT 
Y16=-6. 767E-3*U"R 
Y17=-4. 511E-6"U*"P 
Y18--4.076E-5*U*y 

Y19 J 65JE 5 USU DP 
RDOT2Y144Y154Y164Y174Y184Y19 
P-INTGRL(.O,PDOT) 
V=INIGRL(. 0, VDOT) 
R=INIGRL(. 0 ,RDOT) 
PHI=INTGRL(O. 0,P) 
XI=INIGRL(.0,R) 


IFCU. LT. 20.3) LIM=0. 070 
ΙΡ) ΠΠ 
ΙΡ GE ο ο DEOS 
ERR = ORYAW - XI 

ΠΕ; ΠΗ ΠΠ D DEI) 


*COMPENSATOR GC11 


LCiA = -K1*LERR 
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(one = LEDLAG(O. ,100..10. ,LC1A) 
DR = REALPL(O. ,. 667,LC1B) 
DRDEG = DR*57. 296 
ROLDEG= PHI*57. 296 
YAWDEG= XI*57. 296 
CONTROL  FINTIM=360 
PRINT |. ,V,YAWDEG,DRDEG,ROLDEG 
SAVE 0.1,V,YAWDEG,ROLDEG,DRDEG 
GRAPH(DEZTEK618)TIME,YAWDEG, ROLDEG 
LABEL 15 DEGREE COURSE CHANGE U=18 KTS. 
GRAPH(DEZTEK618)TIME,DRDEG 
LABEL RUDDER RESPONSE TO 15 DEG. COURSE CHANGE U=18 KTS. 





APPENDIX I. 


EQUATIONS OF MOTION 


SIMULATION PROGRAM FOR NON-LINEAR 


*THIS PROGRAM SIMULATES NON-LINEAR EQUATIONS OF MOTION IN SIX DEGREES 


3 


PARAH UC = 


5 


15,58 


τ 


"Ρο ο υπ. 


ARAM AT = το  δοΟΕΡ-» 
ΑμΕΑ ΤΕ το 800E -5 
*ARAM AU = 1. 400E-5 
“να ομα 
ARAM AT = -1. 03F-5 
SARAN FT = SESS 
*ARAM AU = 2.500E-5 
προς ο τα. 
ARAM AT = στ ο. 
"ARAM FIT = 1. 858-5 
*ARAM AU = 4.50E-5 
τν; 
ARAM CAT m2 955 
"ARAM PT — 25235525 
“ARAM AU = 5. 70E-5 
ΝΠ ΤΡ 
PARAM AT = -2.85E-5 
PARAM FT = 2565-5 
PARAM AU = 7.00E-5 
SEDES 
ARAM ΑΙ =o, Leh) 
“ARAM FT = 4. 1368-5 
*ARAM AU = 9.77E-5 
FOR 1815 
*ARAM AT - -8.400E-5 
"ARAM CEP 208050085 
*ARAM AU - 1.80E-4 
ΤΙ; 
ΠΑΠΑ οἱ το. 
“ARAM FI = 97 060-5 
= 2.100E-4 


*ARAM AU 
"PRECAECUEATEDOCOPAUTORS 


PARAM DEL-. 18901E-16, 
PARAM COFAD = 0.0, 

PARAM COFBB=. 153152E-14, 
PARAM COFBF=. 17543E-12, 


OF FREEDOM FOR A SUBNERGED SUBMARINE 


TITLE NONLINEAR SIX DEGREE OF FREEDOM SUBMARINE SIMULATION 


*BALLAST TANKS CONTAINS FOR DIFFERENT AXIAL SPEEDS 


COFAA=. 212502E-14, COFAB = 0.0, 
COFAE = 0.0, COFAF = 0.0, 
COFBC=0. 0, COFBD=-. 186106E-10, 
COFCA=0. 0, COFCB = 0.0,  COFCC 
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COFAC = 0.0 
COFBA = 0.0 
COEBE ΞΟ 
=. 11665E-14 





Banat COFCD = 0.0, ο ο ο ο ο ο το Ομ ο COFDA = 0.0 

ο. ο. COFDB=-. 905797E-16,COFDC=0. 0, COFDD=. 294191E-11, COFDE = 0.0 

meee COPDF=-. 224359E-13 ,COFEA=0. 0, COFEB = 0.0, CGE C= οὐ 18 

PARAM COFED = 0.0, CORRES οσοι COFEF = 4080), COFFA = 0:0 

Pewee COPFB=. 162929E-17, COFFC=0. 0, SURBD-E-.9155999- 15, COFEE = 0.0 
ITF =. 1/9521E-13 


PARA!Í 


*HYDRODYNANIC COEFFICIENTS AND SUBMARINE CHARACTERISTICS 


Þe 


PARAM LC = 415.0, ML = . 0087445, Al = -0.001, A2 = -.00095, A3 = .00195 
PARAM IX=7.3114E-6,IY=5.6867E-4, IZ = 5.6867E-4 

PARAM XUDOT =-.00015, XVR = .011, XWQ = -.0075, XVV = .0065, XWW =. 002 
PARAM XDRDR =-.0028, XDSDS=-. 0025 ,XDBDB=-. 0026, XQQ =-.0002, XRR=-. 00009 
PARAM XRP = . 00025 

PARAM YVDOT =-.011, YWP = .0075, =-.021, Y1V1V=-. 06, YR = . 003 
PARAM YVIR1 =-.0073, YP =-. 0007 ,YRDOT=. 00009, YPDOT=-.0003, YDR =. 0062 
PARAM YPQ 2.0002,  YWV =-.065 

PARAM ZWDOT =-.0075, ZVP =-.007, ZS =-.0001, ZW =-.011, ZW1W1=-.03 
PARAM ZVV -.065, ZQ =-.0045,ZW1Q1=-.006,  ZVR =-.008, ZRR =-. 0015 
PARAM ZDS =-.005, ZDB -2-.0025,20D0T2-.0002, Z1W1 = 0.0, ZWW = 0.0 
PARAM ZRP -Ξ-. 0009 

PARAM KPDOT =-3.E-6, KQR =-.0001,KRDOT=-7.F-6, KiP1P=-8.E-7, KV =-.0007 
PARAM KiV1V =-.0009, KP =-3.5E-5, KR =-4.E-5, KVDOT=-. 00025 ,KVW=. 0035 
PARAM KDR =7.E-5,  KWP = 2.5E-4 

PARAM MODOT =-.0004, MRP 2.00015, MS -4.E-5, MW 2.003, MIWIW--.005 
PARAM MVV — 2.015, MQ =-.0025,M1W1Q=-.002, MVR =-.004, MRR=-.00055 
PARAM MWDOT =-.0002, MDS =-.0025, MDB =.0005, M1W1 = 0.0, HVP =.0009 
PARAM NRDOT =-5.E-4, NPQ =-4.E-4,NPDOT=-7.E-6, NV Ξ-. 0075 ΝΙΝΙΝΞ. 014 
PARAM NR -2-.003, NIVIR 2-.0045, NP =-2.E-6,NVDOT =.0003, NDR =-. 003 
PARAM NWV =.015, NWP --.0002 

PARAM BZB -1.011Δ13Ε-3 

INCON YADOT = 0.0, RODOT = 0.0, PIDOT = 0.0 

meen DS = 0.0 , DB = 0.0, DR =0.0 


CONTRL FINTIN=360. ,DELT=. 01,DELS=. 5 
PRINT 1. ,V,YAWGRA,ROLGRA, DEPTH, PITGRA 


INITIAL 
LC2 
IZX 
JO 
IE 


LC?**2 
psp 
ΠΕΙ; 
TY 


DYNAMIC 

. 10) 
. 10) 
. 40) 
. 40) 


. 70) 
. 70) 


0.611 
υ ος 
ΠΠ 
20 361] 


ὃς DE TIHE: 
5 IE TINE. 

TE TIME.: 
i TA TIME. 
+e I ΤΗ. 
* μι PME, 


= 
Po) 
l H H H H I| 
= 
< 


co 
e 


sz 


DERIVATIVE 


? 


*PRECALCULATION FOR EQUATIONS OF MOTION 


¢ 


PAL = XDRDR*U*U*"DR*DR/LC 





PA2 
PA3 
PB 
PC2 
PC3 
PD 
PE2 
PE3 
PF 
PA 
PC 
PE 
ABV 
ABW 
ABP 
ABQ 
ABR 


XDSDS*U*U*DS*DS /LC 
XDBDB*U*U*DB*DB/LC 
YDR*U*U*DR/LC 
ZDS*U*U*DS /LC 
ZDB*U*U*DB/LC 
KDR*U*U*DR/LC2 
MDS*U*U*DS/LC2 
MDB*U*U*DB/LC2 
NDR*U*U*DR/LC2 

PA1 + PA2 + PA3 
Ped + Pes 

ΠΤ», ΠΤ 

ABS(V) 

ABS(W) 

ABS(P) 

ABSCQ) 

ABS(R) 


VVWW= VV + WW 


AVW 


— SQRT(VVWW) 


ABWP-FCNSW(W,-1. ,0. ,1. ) 
ABVP=FCNSW(V,-1. ,0. ,1. ) 


SA1 
SA2 
SA3 
SA4 
SB] 


S52 
SE3 
SEA 


=+LC0*( XQQ*Q** 2 ^ XRRZ*R?*«2 + XRP*R*P) 

=+(ML*V*R - XVR*V*R + XWQ*W*Q -ML*W*Q) 

=4( XVV* V2 4 XWW*W**2)/LC - SINCPITCH)*( AT-FT-AU) 

=+( Al*U*-*2 + A2*UF*UC 4 A3*UC? 72 ) ZI 

=+LC*YPQ*P*Q 

=+(YWP*W*P + YVIR1*ABR*AVW*ABVP +ML*W*P - ML*U*R) 

=+( YWV"WeV + YIVIV*AVW*V)/LC + SINCROLL)*COS( PITCH)*( AT+FT+AU ) 
-(YR*R +YP*P TYV*V/LC)*U 

= LO*R*( ZRR*R + ZRP*P) 

—H(ZVP*V*P 4 ZVR*V*R - ZWIQI*ABQ*AVW*ABWP 4 ML*U*Q - ML*P*V) 
—-HL(ZWW*W'*2 - ZVV*V*2 - ZWIWI*W*AVW - U*ZIWI*ABW + U*U*ZS)/LC 
= ZQ*U*Q + ZW*U*W/LC + COS( PITCH)*COS(ROLL)*( AT+FT+AU) 
=+(KQR*Q"R + KIPIP*ABP*P) - IZY*Q*R 

= (KWP*W*P-BZB*SIN(CROLL)*COS( PITCH) )/LC 

=+(K1V1V#V%#AVW + KVW*V*W + KS*U**2)/LC2 

((KP*P + KR*R)/LC + KV*V/LC2)*U 

(MRP*P 4 MRR*R + IZX*P)*R 

CCMVR*R + MVP*P)*V + MIW1Q*AVW*Q - BZB*SINCPITCH))/LC 
(MVV*V3*2  MWW*W'c*2 + MIWLWSAVWEW +M1W1*U%AVW 4 U**2*MS)/LC2 
= NQ*U*Q/LC + (MW*U*W -(175.5*FT-219. 3AP COSC ας ee 


COS(ROLL))/LC2 


SET 
SF2 
SES 
SF4 


SINC ROLL) )/LC2 


- (NPQ-IYX)*P*Q 

=+( NWP*W*P 4 NIVIR&*AVWA*R)/LC 

= (NWV*W + N1VIV*AVW)*V/LC2 

= (NP*P+NR*R)*U/LC+(NV*U"V+( 175. 5%*FT-219. 5*AT)*COS(PITCH)*. .. 


| 
Un 
=> 
EA 


SA2 + SA3 + SA4 
SB2 + SB3 + SBG 
SC2 + SC3 + SC4 
SD2 + SD3 + SD4 
ΕΕ ΓΕ; 
SF2 + SFS rus 
SA + PA 
SB + PB 
SC + PG 


Un 
oO 
= 
+ + + + + + 


l H H H H H H I 
Un 
Er 
n 
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ZD 
ZE 
ο 


ου ΤΡ 
ο ο ie 
DIE 


*EQUATIONS OF NOTION 

ve 
UDOT =(COFAA*ZA+COFAB* ZB+COFAC*ZC+COFAD*ZD+COF AB ZE+COFAF*ZF ) /DEL 
VDOT =(COFBA**ZA+COF BB*ZB+COF BC* ZC+COF BD*ZD+COFBE*ZE+COFBF”ZE ) /DEL 
WDOT =(COFCA*ZA+COFCB* ZB+COFCC*ZC+COFCD*ZD+COFCE* ZE+COFCF* ZF ) /DEL 
PDOT =(COFDA*ZA+COFDB*ZB+COFDC*ZC+COFDD* ZD+COF DE* ZE+COFDF* ZF ) / DEI, 
QDOT =(COFEA*ZA+COFEB*ZB+COFEC*ZC+COFED*ZD+COFEE*ZE+COFEF ZF ) / DET, 
RDOT =(COFFA*ZA+COFFB* ZB+COFFC*ZC+COF FD" ZD+COFFE*ZE+COFFF*ZF) /DEL 

Y» 


*AUXILARY EQUATIONS 


¢ 


ZODOT =-U*SIN( PITCH)+V*COS( PITCH) **S IN( ROLL )+W*COS( PITCH) **COS(ROLL) 

PIDOT = Q*COS(ROLL)-R*SIN(ROLL) 
YADOT = (R*COS(ROLL)+Q*SIN( ROLL) ) /COS( PITCH) 
RODOT = P+YADOT*SIN( PITCH) 
U = INTGRL(UC, UDOT) 
V = INTGRL(O. , VDOT) 
W = INTGRL(O. ,WDOT) 
P - INTGRL(O. ,PDOT) 
Q = INTGRL(O. ,QDOT) 
R = INTGRL(O. ,RDOT) 
DEPTH = INTGRL(O. ,ZODOT) 

* ROLL = INTGRL(0. 43633 ,RODOT) 
ROLL = INTGRL(0.0,RODOT) 

* PITCH 2 INTGRL(O. 7854, PIDOT) 
PITCH = INTGRL(0. 0,PIDOT) 
YAW = INTGRL(O. , YADOT) 
DBGRA = DB*57. 296 
DSGRA = DS*57. 296 
DRGRA = DR*57. 296 


PITGRA= PITCH*57. 296 
ROLGRA= ROLL*57. 296 
YAWGRA- YAW*57.296 
SAVE 0.1,V,DEPTH,YAW,PITGRA, ROLL, ZODOT 
GRAPH( DE=TEK618)TINE , DEPTH , ZODOT, PITGRA 
LABEL NI. PITCHO. O4RAD. U=18.58 FT/SEC. NO PLANES 
GRAPH(DE-TEK618)TIME,ROLL,YAW,V 
LABEL  INI.ROLL-0.1 RAD. U=18.580 FT/SEC. NO PLANES 


l6] 





APPENDIX I. COMPENSATED NON-LINEAR MODEL 


c 


*THIS PROGRAM SIMULATES THE COMPENSATED NON-LINEAR SUBMARINE IN SIX 


*DEGREESSODESRRISEDOD 


sc 


TITLE COMPENSATED NONLINEAR SIX DEGREE OF FREEDOM SUBMARINE SIMULATION 


PARAM KH = 1.00 
PARAM K1 - 0.015 
PARAM K2 = 2.0 

PARAN UC = 18. 69 


*ARAM ORYAW=1. 5726 
PARAM ORYAW=0. 2618 
*PARAM ZOR=10. 
PARAM POR=0. 0 


ην 


*BALLAST TANKS CONTAINS FOR DIFFERENT AXIAL SPEEDS 


ET 


*FOR 5 KTS | 
“ARAM AT = -0. 800E-5 
*ARAM FT = 0. 800E-5 
“ARAM AU = 1. 400E-5 
*FOR 6 KTS 
*ARAM AT 7 -1.030E-5 
*ARAM FT = 1.030E-5 
*ARAM AU = 2. 500E-5 
“FOR 8 KTS 
*ARAM AT 7 -1.85E-5 
*ARAM FT 7 1.85E-5 
*ARAM AU = 4. 5E-5 
*FOR 9 KTS 
PARAM AT = -2.35E-5 
PARAM FT = 2. 35E-5 
PARAM AU = 5. 7E-5 
*FOR 12KTS 
*ARAM AT — -4. 138E-5 
*ARAM FT 7 4. 138E-5 
*ARAM AU - 9. 77E-5 
*FOR 18KTS 
"ARAM AT - -8.400E-5 
“ARAM FT = 8.400E-5 
“ARAM AU = 1. 80E-4 
*FOR 25KTS 
*ARAM AT = -9.080E-5 
*ARAN FT = 9. 080E-5 
= 2 1D0FE-¿ 


ARAM AU 


C 


*PRECALCULATED COFACTORS 
PARAM DEL=. 18901E-16, COFAA=. 212502E-14, COFAB = 0.0, COFAC 
PARAM COFAD = 0.0, COFAE = 0.0, COFAE =e) 0: COFBA 
PARAN COFBB=. 153152E-14, COFBC=0.0, COFBD--.186106E-10,  COFBE 
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SIDS 
οσο ο 





PARA! 
PARAM 


PARAH 


PARAH 


PARA? 


— 


PARAM 


PARAM 


xt 


PARAM 
PARAM 
PARAM 
PARAH 
PARAH 
PARAM 
PARAM 
PARAM 
PARAM 
PARAM 
PARAM 
PARAM 
PARAM 
PARAM 
PARAM 
PARAM 
PARAM 
PARAM 
PARAM 
PARAM 
PARAM 
PARAH 
INCON 
INCON 


ὃς 


COFBF=. 17543E-12, 


COFCD = 0.0, 


COFDB=-. 905797E-16 ,COFDC=0. 0, 
COFDF=-. 224359E-13,COFEA=0. 0, 


COFED = 0.0, 


COFCA=0. 0, 


*HYDRODYNANIC COEFFICIENTS AND SUBMARINE CHARACTERISTICS 


LC = 415.0, ML = .0087445, Al = -0.001, 


IX=7. 3114E-6,1Y=5. 6867E-4, IZ = 5. 6867E-4 
XUDOT =-.00015, XVR = 
-.0028, XDSDS- 
. 00025 


XDRDR 
XRP 
YVDOT 
YV1R1 
YPQ 
ZWDOT 
ZVV 
ZDS 
ZRP 
KPDOT 
K1V1V 
KDR 
MQDOT 
MVV 
MWDOT 
NRDOT 
NR 
NWV 
BZB 
YADOT 
ΠΞ - 


INITIAL 


3 
Ἂς 


* 


LC2 
128 
IYX 
a 


DYNAMIC 


ECU. 
ECU. 
τος. 
ee CU: 
του. 
IF(U. 
HER 
ZER 
PER 
ZERR= 


H H H 


0. 


-.011, 


-.0073, 


ο. 


-.0075, 


. 065, 
1005, 


-. 0009 
-3.E-6, 
-.0009, 


7.E-5, 


-. 0004, 


OME, 


-. 0002, 
-5.E-4, 
-.003, NIVIR 


BONS. 


0115155255) 


Hog H H H Il 


I lo H ow Hl 


-.0045, 


π᾿ ου», AVV οσους. τη 
70025, .DBDB==, 0026, 


k S02]7 
. 0007 , YRDOT-. 00009, 
. 065 
.007, | ZS =-.0001, 
. 0045, ZW1Q1--. 006, 
. 0025, ZQDOT--. 0002, 


. 0001,KRDOT--7. E-6, 
ο ροκ τς ο, 
2.5E-4 

.00015, MS -4.E-5, 
.0025,M1W1Q--. 002, 
=-, 0025, MDB =. 0005, 
-4. E-4 ΝΡΡΟΤΞ-7.Ε-6. 
NP =-2. E-6,NVDOT 


0002 


0.0, RODOT = 0.0, PIDOT = 0.0 
0 , DB = 0.0, DR =0.0 
CONTRL FINTIN=360. ,DELT=. 01,DELS=. 5 


We? 


I 
I 
I 


GE 
0 


Ζ-1Χ 
eas 
Bay 


*ERROR LINIT CALCULATION 


το ο ΕΚ. 
ο με Ες 
ο ο ο ae Oe 


PRINT 1. , YAWDEG, ROLDEG , DEPTH , PITDEG ,U 


25 


. 20.3) LIMHOR-O. 070 
. 20.3) LINHOR=0. 050 
οὐ ο οκ. 05 


RYAW - YAW 
ZOR - DEPTI 
POR - PITCH 


LIMITCZBPHMUVERSLIMVER,ZER) 
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CODO ον 
COFCE--.999506E-13,COFCF = 0.0, 
COFDD=. 294191E-11, 
COFEB = 0.0, 
COFEE=. 19562E-13, 
COFFB=. 162929E-17, COFFC=0.0, 
COFFF =. 179521E-13 


-.00095, A3 = 


-.0002, XRR=- 


ΤΙ στ. 
YPDOT=-2 0003, YUR 


K1P1P=-8.E-7, KV 
KVDOT=-. 00025 ,KVW=. 0035 


n | 


. 11665F 714 
COFDA = 0.0 


Ὁ 


COFEC=-. 58035E-18 
COFEF = 0.0, 
CODPD-- 91959T1E»I3, 


[orto 
Uo 


DIS 


=. 002 
. 00009 


2005 
. 0062 


ZW =-.011, ZW1W1=-.03 


ZVR =-.008, ZRR =-.0015 


0.0 


270007 


.003, M1W1W=-. 005 
-.004, MRR=-. 00055 
MVP =. 0009 
-.0075 ,NIVIV=. 014 
-. 003 





xe 


HERR- LIMIT( -LIMHOR,LIMHOR,HER) 


DERIVATIVE 


*X 


*PRECALCULATION FOR EQUATIONS OF MOTION 


ος 


ΡΑΙ 2 XDRDR*U*U*DR*DR/LC 
PA2 2 XDSDS*U*U*DS*DS/LC 
PA3 2 XDBDB*U*U*DB*DB/LC 
PB = YDR*U*U*DR/LC 

PC2 = ZDS*U*U*DS/LC 

PC3 - ZDB*U*U*DB/LC 

PD - KDR*U*U*DR/LC2 

PE2 = MDS*U*U*DS/LC2 

PE3 = MDB*U*U*DB/LC2 

PF - NDR*U*U*DR/LC2 

PA = PAl + PA2 + PA3 

PC = PC2 + PC3 

PE = PE2 + PE3 

ABV = ABS(V) 

ABW = ABS(W) 

ABP = ABS(P) 

ABQ = ABS(Q) 

ABR = ABS(R) 


VVWW- V*V + WW 

AVW = SQRT(VVWW) 

ABWP=FCNSW(W,-1. ,0. ,1. ) 

ABVP=FCNSW(V,-1. ,0. ,1. ) 

SA] —-LC*(XQQ*Q**2 - XRR*R?**2 + XRP*R*P) 

SA2 --(ML*V*R 4 XVR*V*R 4 XWQ"W*Q -ML'*W*Q) 

SA3 =+( XVV*V*%2 c XWW*W*2)/LC - SINC PITCH) *(AT+FT+AU) 

SAG —E(AI*U**2 4 A2*USUCO O j pO 

SB1 =+LC*YPQ*P*Q 

SB2 =+( YWP*W*P + YVIRL*ABR*AVW*ABVP 4ML*W*P - ML*U*R) 

SB3 —-(YWV*W*V + YIVIV*AVW*V)/LC + SINCROLL)*COS( PITCH)*( AT+FT+AU ) 
SB4 -(YR*R 4YP*P +YV*V/LC)*U 

SC1 = LC*R*(ZRR*R + ZRP*P) 

SC2 -t(ZVP*V*P * ZVR*V*R + ZWIQI*ABQ*AVW*ABWP + ML*U*Q - ML*P*V) 
SC3 --(ZWW*W**2 t ZVV*V**2  ZWIWI*W*AVW t U*ZIW1*ABW 4 U*U*285)/LC 
SC4 = ZQ*U"Q + ZW*U*W/LC + COS( PITCH)*COS(ROLL)*(AT+FT+AU ) 

SD1 =+(KQR*Q*R + K1P1P*ABP*P) - IZY*Q*R 

SD2 = ( KWP*W*P-BZB*SIN(ROLL)*COS(PITCH))/LC 

SD3 =+(K1V1V*V*AVW + KVW*V*W + KS*U**2)/LC2 

SD4 = ((KP*P + KR*R)/LC + KV*V/LC2)*U 


SE1 = (MRP*P + MRR*R + IZX*P)*R 
SE2 = ((MVR*R + MVP*P)*V + MIW1Q**AVW*Q - BZB*SIN(PITCH))/LC 
SE3 =(MVVFVI%2 4 MWW*Wiet2 + M1W1W*AVW*W +M1W1%U#AVW 4 U**2*MS)/LC2 


SE4 = MQ*U*Q/LC + (MW*U"W -(175.5*FT-219. 5*AT)*COS(PITCIHD)*. .. 
COS(ROLL))/LC2 

SF1 2 (NPQ-IYX)*P*Q 

SF2 =+(NWP*W*P + NIVIR*AVW*R) /LC 

SF3 = (NWV"W  NIVIV*AVW)*V/LC2 

SF4 = (NP*P+NR*R)*U/LC+(NV*U*V+( 175. 5*FT-219. 5°*AT)*COS(PITCH)*. . 
SIN(ROLL))/LC2 

SA = SAl + SA2 + SA3 + SA4 

SB = SB1 + SB2 + SB3 + SB4 
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sc 


*EQUATIONS 


9e 


C SCl t SC2 + ου 
ewe oD oD 513 
EN — SEISE? F SES 
See OF lt or? + SES 
gi = SA + PA 
ZB = SB + PB 
Bo, = SC + PC 
¿D = SD + PD 
aoe = SE + PE 
oa — of + PF 

OF MOTION 


UDOT =( COFAA*ZA+COFAB* 
VDOT =(COFBA*ZA+COFBB* 
WDOT =(COFCA*ZA+COFCB* 
PDOT =(COFDA*ZA+COFDB* 
QDOT =(COFEA*ZA+COFEB* 
RDOT =(COFFA*ZA+COFFB*ZB+COFFC* 


*AUXILARY EQUATIONS 


ZODOT 
PIDOT 
YADOT 
RODOT 
U 
V 
W 
p 


Q 
R 


H 
H Jo H II 


l H H H 


II 


* SCA 
t SD4 
F SEG 
+ SF4 


ZB+COFAC* 
ZB+COFBC* 
ZB+COFCC* 
ZB+COFDC* 


ZC+COFAD*ZD+COF AE* 
ZOCOR ERD ZD: GOEDD- 
ΕΕ COG) ZD7COPCE™ 
°ZC+COFDD*ZD+COFDE: 
ZB+COFEC* 


ZC+COFED*ZD+COFEE 


(R**COS( ROLL) +0**SIN( ROLL) ) /COS( PITCH) 


P+YADOT*SIN( PITCH) 
INTGRL( UC , UDOT) 
INTGRL(O. , VDOT) 
INTGRL(O. ,WDOT) 
INTGRL(O. , PDOT) 
INTGRL(O. ,QDOT) 
INTGRL(O. , RDOT) 


DEPTH - INTGRL(O. 0, ZODOT) 
INTGRL(0. 0,RODOT) 
INTGRL(0. 0, PIDOT) 
INIGRL(O. , YADOT) 
*COMPENSATOR 6011 


ROLL 
PITCH 
YAW 


C11 
512 
DB 


SK 


]1* ZERR 


*COMPENSATOR GC22 


=e 


Cag 
DS 


xi: 


Ες 


“COMPENSATOR GC 


zc 


C1 EM 


C2 


*HERR 


Πρ ο I 0 Ou CU 
REALPL(O. ,. 667,C12) 


REALPL(0. ,. 667,C21) 


LEDLAG(O. ,100. ,10. ,C1) 


DR = REALPL(O. ,. 667,C2) 


DBDEG 
DSDEG 
DRDEG 
PITDEG= 
ROLDEG= 


WE 52 70 
ΘΕ 

DR 57.296 
PCT 57 ο 
ROLE 3577296 
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ZETCOFAF*ZF)/DEL 
ZETOUPDDE ZP D 
ΡΕ 7 DEL 


SZESOODEDESZE)/DET, 
S RTFCOFEF = ZF) /DEL 
ZC+COFFD*ZD+COFFE* 


Zs GOrEE ZF )/DEL 


-U*S IN( PITCH) +V*COS( PITCH) *SIN( ROLL) +W**COS( PITCH) *COS( ROLL) 
Q**COS( ROLL) -R*SIN(ROLL) 








YAWDEG= YAW*57. 296 
SAVE | 0. 1,V, ZDOT,DEPTH,PITDEG, RODDEG, YAWDEG ,DRDEG, DSDEG,DBDEG 
GRAPH( DE=TEK618 )TIME , ROLLDEG , YAWDEG,V 
LABEL 15 DEGREE COURSE CHANGE U=10 KTS. 
ΠσΚΑΔΡΗ(ΡΕΞΤΡΚ6ΙΟ ΠΡ ΕΩΟ ΕΡΕ ΕΤΗ DOT 
*LABEL 10 FEET DEPTH CHANGE U=10 KTS. 
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